EL4121 Embedded System / mbed-os

mbed-os

Dependents:   cobaLCDJoyMotor_Thread odometry_omni_3roda_v3 odometry_omni_3roda_v1 odometry_omni_3roda_v2 ... more

targets/TARGET_STM/TARGET_STM32L1/analogin_device.c@0:b74591d5ab33, 2017-12-11 (annotated)

Committer:
be_bryan
Date:
Mon Dec 11 17:54:04 2017 +0000
Revision:
0:b74591d5ab33
motor ++

Who changed what in which revision?

UserRevisionLine numberNew contents of line
be_bryan 0:b74591d5ab33 1 /* mbed Microcontroller Library
be_bryan 0:b74591d5ab33 2 * Copyright (c) 2016, STMicroelectronics
be_bryan 0:b74591d5ab33 3 * All rights reserved.
be_bryan 0:b74591d5ab33 4 *
be_bryan 0:b74591d5ab33 5 * Redistribution and use in source and binary forms, with or without
be_bryan 0:b74591d5ab33 6 * modification, are permitted provided that the following conditions are met:
be_bryan 0:b74591d5ab33 7 *
be_bryan 0:b74591d5ab33 8 * 1. Redistributions of source code must retain the above copyright notice,
be_bryan 0:b74591d5ab33 9 * this list of conditions and the following disclaimer.
be_bryan 0:b74591d5ab33 10 * 2. Redistributions in binary form must reproduce the above copyright notice,
be_bryan 0:b74591d5ab33 11 * this list of conditions and the following disclaimer in the documentation
be_bryan 0:b74591d5ab33 12 * and/or other materials provided with the distribution.
be_bryan 0:b74591d5ab33 13 * 3. Neither the name of STMicroelectronics nor the names of its contributors
be_bryan 0:b74591d5ab33 14 * may be used to endorse or promote products derived from this software
be_bryan 0:b74591d5ab33 15 * without specific prior written permission.
be_bryan 0:b74591d5ab33 16 *
be_bryan 0:b74591d5ab33 17 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
be_bryan 0:b74591d5ab33 18 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
be_bryan 0:b74591d5ab33 19 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
be_bryan 0:b74591d5ab33 20 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
be_bryan 0:b74591d5ab33 21 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
be_bryan 0:b74591d5ab33 22 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
be_bryan 0:b74591d5ab33 23 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
be_bryan 0:b74591d5ab33 24 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
be_bryan 0:b74591d5ab33 25 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
be_bryan 0:b74591d5ab33 26 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
be_bryan 0:b74591d5ab33 27 */
be_bryan 0:b74591d5ab33 28 #include "mbed_assert.h"
be_bryan 0:b74591d5ab33 29 #include "analogin_api.h"
be_bryan 0:b74591d5ab33 30
be_bryan 0:b74591d5ab33 31 #if DEVICE_ANALOGIN
be_bryan 0:b74591d5ab33 32
be_bryan 0:b74591d5ab33 33 #include "mbed_wait_api.h"
be_bryan 0:b74591d5ab33 34 #include "cmsis.h"
be_bryan 0:b74591d5ab33 35 #include "pinmap.h"
be_bryan 0:b74591d5ab33 36 #include "mbed_error.h"
be_bryan 0:b74591d5ab33 37 #include "PeripheralPins.h"
be_bryan 0:b74591d5ab33 38 #include <stdbool.h>
be_bryan 0:b74591d5ab33 39
be_bryan 0:b74591d5ab33 40 void analogin_init(analogin_t *obj, PinName pin)
be_bryan 0:b74591d5ab33 41 {
be_bryan 0:b74591d5ab33 42 static bool adc_hsi_inited = false;
be_bryan 0:b74591d5ab33 43 RCC_OscInitTypeDef RCC_OscInitStruct;
be_bryan 0:b74591d5ab33 44 uint32_t function = (uint32_t)NC;
be_bryan 0:b74591d5ab33 45
be_bryan 0:b74591d5ab33 46 // ADC Internal Channels "pins" (Temperature, Vref, Vbat, ...)
be_bryan 0:b74591d5ab33 47 // are described in PinNames.h and PeripheralPins.c
be_bryan 0:b74591d5ab33 48 // Pin value must be between 0xF0 and 0xFF
be_bryan 0:b74591d5ab33 49 if ((pin < 0xF0) || (pin >= 0x100)) {
be_bryan 0:b74591d5ab33 50 // Normal channels
be_bryan 0:b74591d5ab33 51 // Get the peripheral name from the pin and assign it to the object
be_bryan 0:b74591d5ab33 52 obj->handle.Instance = (ADC_TypeDef *)pinmap_peripheral(pin, PinMap_ADC);
be_bryan 0:b74591d5ab33 53 // Get the functions (adc channel) from the pin and assign it to the object
be_bryan 0:b74591d5ab33 54 function = pinmap_function(pin, PinMap_ADC);
be_bryan 0:b74591d5ab33 55 // Configure GPIO
be_bryan 0:b74591d5ab33 56 pinmap_pinout(pin, PinMap_ADC);
be_bryan 0:b74591d5ab33 57 } else {
be_bryan 0:b74591d5ab33 58 // Internal channels
be_bryan 0:b74591d5ab33 59 obj->handle.Instance = (ADC_TypeDef *)pinmap_peripheral(pin, PinMap_ADC_Internal);
be_bryan 0:b74591d5ab33 60 function = pinmap_function(pin, PinMap_ADC_Internal);
be_bryan 0:b74591d5ab33 61 // No GPIO configuration for internal channels
be_bryan 0:b74591d5ab33 62 }
be_bryan 0:b74591d5ab33 63 MBED_ASSERT(obj->handle.Instance != (ADC_TypeDef *)NC);
be_bryan 0:b74591d5ab33 64 MBED_ASSERT(function != (uint32_t)NC);
be_bryan 0:b74591d5ab33 65
be_bryan 0:b74591d5ab33 66 obj->channel = STM_PIN_CHANNEL(function);
be_bryan 0:b74591d5ab33 67
be_bryan 0:b74591d5ab33 68 // Save pin number for the read function
be_bryan 0:b74591d5ab33 69 obj->pin = pin;
be_bryan 0:b74591d5ab33 70
be_bryan 0:b74591d5ab33 71 // Configure ADC object structures
be_bryan 0:b74591d5ab33 72 obj->handle.State = HAL_ADC_STATE_RESET;
be_bryan 0:b74591d5ab33 73 obj->handle.Init.ClockPrescaler = ADC_CLOCK_ASYNC_DIV4;
be_bryan 0:b74591d5ab33 74 obj->handle.Init.Resolution = ADC_RESOLUTION_12B;
be_bryan 0:b74591d5ab33 75 obj->handle.Init.DataAlign = ADC_DATAALIGN_RIGHT;
be_bryan 0:b74591d5ab33 76 obj->handle.Init.ScanConvMode = DISABLE; // Sequencer disabled (ADC conversion on only 1 channel: channel set on rank 1)
be_bryan 0:b74591d5ab33 77 obj->handle.Init.EOCSelection = EOC_SINGLE_CONV; // On STM32L1xx ADC, overrun detection is enabled only if EOC selection is set to each conversion (or transfer by DMA enabled, this is not the case in this example).
be_bryan 0:b74591d5ab33 78 obj->handle.Init.LowPowerAutoWait = ADC_AUTOWAIT_UNTIL_DATA_READ; // Enable the dynamic low power Auto Delay: new conversion start only when the previous conversion (for regular group) or previous sequence (for injected group) has been treated by user software.
be_bryan 0:b74591d5ab33 79 obj->handle.Init.LowPowerAutoPowerOff = ADC_AUTOPOWEROFF_IDLE_PHASE; // Enable the auto-off mode: the ADC automatically powers-off after a conversion and automatically wakes-up when a new conversion is triggered (with startup time between trigger and start of sampling).
be_bryan 0:b74591d5ab33 80 obj->handle.Init.ChannelsBank = ADC_CHANNELS_BANK_A;
be_bryan 0:b74591d5ab33 81 obj->handle.Init.ContinuousConvMode = DISABLE; // Continuous mode disabled to have only 1 conversion at each conversion trig
be_bryan 0:b74591d5ab33 82 obj->handle.Init.NbrOfConversion = 1; // Parameter discarded because sequencer is disabled
be_bryan 0:b74591d5ab33 83 obj->handle.Init.DiscontinuousConvMode = DISABLE; // Parameter discarded because sequencer is disabled
be_bryan 0:b74591d5ab33 84 obj->handle.Init.NbrOfDiscConversion = 1; // Parameter discarded because sequencer is disabled
be_bryan 0:b74591d5ab33 85 obj->handle.Init.ExternalTrigConv = 0; // Not used
be_bryan 0:b74591d5ab33 86 obj->handle.Init.ExternalTrigConvEdge = ADC_EXTERNALTRIGCONVEDGE_NONE;
be_bryan 0:b74591d5ab33 87 obj->handle.Init.DMAContinuousRequests = DISABLE;
be_bryan 0:b74591d5ab33 88
be_bryan 0:b74591d5ab33 89 __HAL_RCC_ADC1_CLK_ENABLE();
be_bryan 0:b74591d5ab33 90
be_bryan 0:b74591d5ab33 91 if (HAL_ADC_Init(&obj->handle) != HAL_OK) {
be_bryan 0:b74591d5ab33 92 error("Cannot initialize ADC");
be_bryan 0:b74591d5ab33 93 }
be_bryan 0:b74591d5ab33 94
be_bryan 0:b74591d5ab33 95 // This section is done only once
be_bryan 0:b74591d5ab33 96 if (!adc_hsi_inited) {
be_bryan 0:b74591d5ab33 97 adc_hsi_inited = true;
be_bryan 0:b74591d5ab33 98 // Enable the HSI (to clock the ADC)
be_bryan 0:b74591d5ab33 99 RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSI;
be_bryan 0:b74591d5ab33 100 RCC_OscInitStruct.HSIState = RCC_HSI_ON;
be_bryan 0:b74591d5ab33 101 RCC_OscInitStruct.PLL.PLLState = RCC_PLL_NONE;
be_bryan 0:b74591d5ab33 102 RCC_OscInitStruct.HSICalibrationValue = RCC_HSICALIBRATION_DEFAULT;
be_bryan 0:b74591d5ab33 103 HAL_RCC_OscConfig(&RCC_OscInitStruct);
be_bryan 0:b74591d5ab33 104 }
be_bryan 0:b74591d5ab33 105 }
be_bryan 0:b74591d5ab33 106
be_bryan 0:b74591d5ab33 107 uint16_t adc_read(analogin_t *obj)
be_bryan 0:b74591d5ab33 108 {
be_bryan 0:b74591d5ab33 109 ADC_ChannelConfTypeDef sConfig = {0};
be_bryan 0:b74591d5ab33 110
be_bryan 0:b74591d5ab33 111 // Configure ADC channel
be_bryan 0:b74591d5ab33 112 switch (obj->channel) {
be_bryan 0:b74591d5ab33 113 case 0:
be_bryan 0:b74591d5ab33 114 sConfig.Channel = ADC_CHANNEL_0;
be_bryan 0:b74591d5ab33 115 break;
be_bryan 0:b74591d5ab33 116 case 1:
be_bryan 0:b74591d5ab33 117 sConfig.Channel = ADC_CHANNEL_1;
be_bryan 0:b74591d5ab33 118 break;
be_bryan 0:b74591d5ab33 119 case 2:
be_bryan 0:b74591d5ab33 120 sConfig.Channel = ADC_CHANNEL_2;
be_bryan 0:b74591d5ab33 121 break;
be_bryan 0:b74591d5ab33 122 case 3:
be_bryan 0:b74591d5ab33 123 sConfig.Channel = ADC_CHANNEL_3;
be_bryan 0:b74591d5ab33 124 break;
be_bryan 0:b74591d5ab33 125 case 4:
be_bryan 0:b74591d5ab33 126 sConfig.Channel = ADC_CHANNEL_4;
be_bryan 0:b74591d5ab33 127 break;
be_bryan 0:b74591d5ab33 128 case 5:
be_bryan 0:b74591d5ab33 129 sConfig.Channel = ADC_CHANNEL_5;
be_bryan 0:b74591d5ab33 130 break;
be_bryan 0:b74591d5ab33 131 case 6:
be_bryan 0:b74591d5ab33 132 sConfig.Channel = ADC_CHANNEL_6;
be_bryan 0:b74591d5ab33 133 break;
be_bryan 0:b74591d5ab33 134 case 7:
be_bryan 0:b74591d5ab33 135 sConfig.Channel = ADC_CHANNEL_7;
be_bryan 0:b74591d5ab33 136 break;
be_bryan 0:b74591d5ab33 137 case 8:
be_bryan 0:b74591d5ab33 138 sConfig.Channel = ADC_CHANNEL_8;
be_bryan 0:b74591d5ab33 139 break;
be_bryan 0:b74591d5ab33 140 case 9:
be_bryan 0:b74591d5ab33 141 sConfig.Channel = ADC_CHANNEL_9;
be_bryan 0:b74591d5ab33 142 break;
be_bryan 0:b74591d5ab33 143 case 10:
be_bryan 0:b74591d5ab33 144 sConfig.Channel = ADC_CHANNEL_10;
be_bryan 0:b74591d5ab33 145 break;
be_bryan 0:b74591d5ab33 146 case 11:
be_bryan 0:b74591d5ab33 147 sConfig.Channel = ADC_CHANNEL_11;
be_bryan 0:b74591d5ab33 148 break;
be_bryan 0:b74591d5ab33 149 case 12:
be_bryan 0:b74591d5ab33 150 sConfig.Channel = ADC_CHANNEL_12;
be_bryan 0:b74591d5ab33 151 break;
be_bryan 0:b74591d5ab33 152 case 13:
be_bryan 0:b74591d5ab33 153 sConfig.Channel = ADC_CHANNEL_13;
be_bryan 0:b74591d5ab33 154 break;
be_bryan 0:b74591d5ab33 155 case 14:
be_bryan 0:b74591d5ab33 156 sConfig.Channel = ADC_CHANNEL_14;
be_bryan 0:b74591d5ab33 157 break;
be_bryan 0:b74591d5ab33 158 case 15:
be_bryan 0:b74591d5ab33 159 sConfig.Channel = ADC_CHANNEL_15;
be_bryan 0:b74591d5ab33 160 break;
be_bryan 0:b74591d5ab33 161 case 16:
be_bryan 0:b74591d5ab33 162 sConfig.Channel = ADC_CHANNEL_TEMPSENSOR;
be_bryan 0:b74591d5ab33 163 break;
be_bryan 0:b74591d5ab33 164 case 17:
be_bryan 0:b74591d5ab33 165 sConfig.Channel = ADC_CHANNEL_VREFINT;
be_bryan 0:b74591d5ab33 166 break;
be_bryan 0:b74591d5ab33 167 case 18:
be_bryan 0:b74591d5ab33 168 sConfig.Channel = ADC_CHANNEL_18;
be_bryan 0:b74591d5ab33 169 break;
be_bryan 0:b74591d5ab33 170 case 19:
be_bryan 0:b74591d5ab33 171 sConfig.Channel = ADC_CHANNEL_19;
be_bryan 0:b74591d5ab33 172 break;
be_bryan 0:b74591d5ab33 173 case 20:
be_bryan 0:b74591d5ab33 174 sConfig.Channel = ADC_CHANNEL_20;
be_bryan 0:b74591d5ab33 175 break;
be_bryan 0:b74591d5ab33 176 case 21:
be_bryan 0:b74591d5ab33 177 sConfig.Channel = ADC_CHANNEL_21;
be_bryan 0:b74591d5ab33 178 break;
be_bryan 0:b74591d5ab33 179 case 22:
be_bryan 0:b74591d5ab33 180 sConfig.Channel = ADC_CHANNEL_22;
be_bryan 0:b74591d5ab33 181 break;
be_bryan 0:b74591d5ab33 182 case 23:
be_bryan 0:b74591d5ab33 183 sConfig.Channel = ADC_CHANNEL_23;
be_bryan 0:b74591d5ab33 184 break;
be_bryan 0:b74591d5ab33 185 case 24:
be_bryan 0:b74591d5ab33 186 sConfig.Channel = ADC_CHANNEL_24;
be_bryan 0:b74591d5ab33 187 break;
be_bryan 0:b74591d5ab33 188 case 25:
be_bryan 0:b74591d5ab33 189 sConfig.Channel = ADC_CHANNEL_25;
be_bryan 0:b74591d5ab33 190 break;
be_bryan 0:b74591d5ab33 191 case 26:
be_bryan 0:b74591d5ab33 192 sConfig.Channel = ADC_CHANNEL_26;
be_bryan 0:b74591d5ab33 193 break;
be_bryan 0:b74591d5ab33 194 #ifdef ADC_CHANNEL_27
be_bryan 0:b74591d5ab33 195 case 27:
be_bryan 0:b74591d5ab33 196 sConfig.Channel = ADC_CHANNEL_27;
be_bryan 0:b74591d5ab33 197 break;
be_bryan 0:b74591d5ab33 198 #endif
be_bryan 0:b74591d5ab33 199 #ifdef ADC_CHANNEL_28
be_bryan 0:b74591d5ab33 200 case 28:
be_bryan 0:b74591d5ab33 201 sConfig.Channel = ADC_CHANNEL_28;
be_bryan 0:b74591d5ab33 202 break;
be_bryan 0:b74591d5ab33 203 #endif
be_bryan 0:b74591d5ab33 204 #ifdef ADC_CHANNEL_29
be_bryan 0:b74591d5ab33 205 case 29:
be_bryan 0:b74591d5ab33 206 sConfig.Channel = ADC_CHANNEL_29;
be_bryan 0:b74591d5ab33 207 break;
be_bryan 0:b74591d5ab33 208 #endif
be_bryan 0:b74591d5ab33 209 #ifdef ADC_CHANNEL_30
be_bryan 0:b74591d5ab33 210 case 30:
be_bryan 0:b74591d5ab33 211 sConfig.Channel = ADC_CHANNEL_30;
be_bryan 0:b74591d5ab33 212 break;
be_bryan 0:b74591d5ab33 213 #endif
be_bryan 0:b74591d5ab33 214 #ifdef ADC_CHANNEL_31
be_bryan 0:b74591d5ab33 215 case 31:
be_bryan 0:b74591d5ab33 216 sConfig.Channel = ADC_CHANNEL_31;
be_bryan 0:b74591d5ab33 217 break;
be_bryan 0:b74591d5ab33 218 #endif
be_bryan 0:b74591d5ab33 219 default:
be_bryan 0:b74591d5ab33 220 return 0;
be_bryan 0:b74591d5ab33 221 }
be_bryan 0:b74591d5ab33 222
be_bryan 0:b74591d5ab33 223 sConfig.Rank = ADC_REGULAR_RANK_1;
be_bryan 0:b74591d5ab33 224 sConfig.SamplingTime = ADC_SAMPLETIME_16CYCLES;
be_bryan 0:b74591d5ab33 225
be_bryan 0:b74591d5ab33 226 HAL_ADC_ConfigChannel(&obj->handle, &sConfig);
be_bryan 0:b74591d5ab33 227
be_bryan 0:b74591d5ab33 228 HAL_ADC_Start(&obj->handle); // Start conversion
be_bryan 0:b74591d5ab33 229
be_bryan 0:b74591d5ab33 230 // Wait end of conversion and get value
be_bryan 0:b74591d5ab33 231 if (HAL_ADC_PollForConversion(&obj->handle, 10) == HAL_OK) {
be_bryan 0:b74591d5ab33 232 return (uint16_t)HAL_ADC_GetValue(&obj->handle);
be_bryan 0:b74591d5ab33 233 } else {
be_bryan 0:b74591d5ab33 234 return 0;
be_bryan 0:b74591d5ab33 235 }
be_bryan 0:b74591d5ab33 236 }
be_bryan 0:b74591d5ab33 237
be_bryan 0:b74591d5ab33 238 #endif