Gan likun / The prosthetic control

The prosthetic control（MIT）

targets/TARGET_STM/TARGET_STM32F4/analogin_api.c@0:20e0c61e0684, 2022-06-23 (annotated)

Committer:
ganlikun
Date:
Thu Jun 23 05:23:34 2022 +0000
Revision:
0:20e0c61e0684
01

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ganlikun 0:20e0c61e0684 1 /* mbed Microcontroller Library
ganlikun 0:20e0c61e0684 2 * Copyright (c) 2016, STMicroelectronics
ganlikun 0:20e0c61e0684 3 * All rights reserved.
ganlikun 0:20e0c61e0684 4 *
ganlikun 0:20e0c61e0684 5 * Redistribution and use in source and binary forms, with or without
ganlikun 0:20e0c61e0684 6 * modification, are permitted provided that the following conditions are met:
ganlikun 0:20e0c61e0684 7 *
ganlikun 0:20e0c61e0684 8 * 1. Redistributions of source code must retain the above copyright notice,
ganlikun 0:20e0c61e0684 9 * this list of conditions and the following disclaimer.
ganlikun 0:20e0c61e0684 10 * 2. Redistributions in binary form must reproduce the above copyright notice,
ganlikun 0:20e0c61e0684 11 * this list of conditions and the following disclaimer in the documentation
ganlikun 0:20e0c61e0684 12 * and/or other materials provided with the distribution.
ganlikun 0:20e0c61e0684 13 * 3. Neither the name of STMicroelectronics nor the names of its contributors
ganlikun 0:20e0c61e0684 14 * may be used to endorse or promote products derived from this software
ganlikun 0:20e0c61e0684 15 * without specific prior written permission.
ganlikun 0:20e0c61e0684 16 *
ganlikun 0:20e0c61e0684 17 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
ganlikun 0:20e0c61e0684 18 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
ganlikun 0:20e0c61e0684 19 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
ganlikun 0:20e0c61e0684 20 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
ganlikun 0:20e0c61e0684 21 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
ganlikun 0:20e0c61e0684 22 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
ganlikun 0:20e0c61e0684 23 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
ganlikun 0:20e0c61e0684 24 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
ganlikun 0:20e0c61e0684 25 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
ganlikun 0:20e0c61e0684 26 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
ganlikun 0:20e0c61e0684 27 */
ganlikun 0:20e0c61e0684 28 #include "mbed_assert.h"
ganlikun 0:20e0c61e0684 29 #include "analogin_api.h"
ganlikun 0:20e0c61e0684 30
ganlikun 0:20e0c61e0684 31 #if DEVICE_ANALOGIN
ganlikun 0:20e0c61e0684 32
ganlikun 0:20e0c61e0684 33 #include "mbed_wait_api.h"
ganlikun 0:20e0c61e0684 34 #include "cmsis.h"
ganlikun 0:20e0c61e0684 35 #include "pinmap.h"
ganlikun 0:20e0c61e0684 36 #include "mbed_error.h"
ganlikun 0:20e0c61e0684 37 #include "PeripheralPins.h"
ganlikun 0:20e0c61e0684 38
ganlikun 0:20e0c61e0684 39 void analogin_init(analogin_t *obj, PinName pin)
ganlikun 0:20e0c61e0684 40 {
ganlikun 0:20e0c61e0684 41 uint32_t function = (uint32_t)NC;
ganlikun 0:20e0c61e0684 42
ganlikun 0:20e0c61e0684 43 #if defined(ADC1)
ganlikun 0:20e0c61e0684 44 static int adc1_inited = 0;
ganlikun 0:20e0c61e0684 45 #endif
ganlikun 0:20e0c61e0684 46 #if defined(ADC2)
ganlikun 0:20e0c61e0684 47 static int adc2_inited = 0;
ganlikun 0:20e0c61e0684 48 #endif
ganlikun 0:20e0c61e0684 49 #if defined(ADC3)
ganlikun 0:20e0c61e0684 50 static int adc3_inited = 0;
ganlikun 0:20e0c61e0684 51 #endif
ganlikun 0:20e0c61e0684 52 // ADC Internal Channels "pins" (Temperature, Vref, Vbat, ...)
ganlikun 0:20e0c61e0684 53 // are described in PinNames.h and PeripheralPins.c
ganlikun 0:20e0c61e0684 54 // Pin value must be between 0xF0 and 0xFF
ganlikun 0:20e0c61e0684 55 if ((pin < 0xF0) || (pin >= 0x100)) {
ganlikun 0:20e0c61e0684 56 // Normal channels
ganlikun 0:20e0c61e0684 57 // Get the peripheral name from the pin and assign it to the object
ganlikun 0:20e0c61e0684 58 obj->handle.Instance = (ADC_TypeDef *) pinmap_peripheral(pin, PinMap_ADC);
ganlikun 0:20e0c61e0684 59 // Get the functions (adc channel) from the pin and assign it to the object
ganlikun 0:20e0c61e0684 60 function = pinmap_function(pin, PinMap_ADC);
ganlikun 0:20e0c61e0684 61 // Configure GPIO
ganlikun 0:20e0c61e0684 62 pinmap_pinout(pin, PinMap_ADC);
ganlikun 0:20e0c61e0684 63 } else {
ganlikun 0:20e0c61e0684 64 // Internal channels
ganlikun 0:20e0c61e0684 65 obj->handle.Instance = (ADC_TypeDef *) pinmap_peripheral(pin, PinMap_ADC_Internal);
ganlikun 0:20e0c61e0684 66 function = pinmap_function(pin, PinMap_ADC_Internal);
ganlikun 0:20e0c61e0684 67 // No GPIO configuration for internal channels
ganlikun 0:20e0c61e0684 68 }
ganlikun 0:20e0c61e0684 69 MBED_ASSERT(obj->handle.Instance != (ADC_TypeDef *)NC);
ganlikun 0:20e0c61e0684 70 MBED_ASSERT(function != (uint32_t)NC);
ganlikun 0:20e0c61e0684 71
ganlikun 0:20e0c61e0684 72 obj->channel = STM_PIN_CHANNEL(function);
ganlikun 0:20e0c61e0684 73
ganlikun 0:20e0c61e0684 74 // Save pin number for the read function
ganlikun 0:20e0c61e0684 75 obj->pin = pin;
ganlikun 0:20e0c61e0684 76
ganlikun 0:20e0c61e0684 77 // Check if ADC is already initialized
ganlikun 0:20e0c61e0684 78 // Enable ADC clock
ganlikun 0:20e0c61e0684 79 #if defined(ADC1)
ganlikun 0:20e0c61e0684 80 if (((ADCName)obj->handle.Instance == ADC_1) && adc1_inited) return;
ganlikun 0:20e0c61e0684 81 if ((ADCName)obj->handle.Instance == ADC_1) {
ganlikun 0:20e0c61e0684 82 __HAL_RCC_ADC1_CLK_ENABLE();
ganlikun 0:20e0c61e0684 83 adc1_inited = 1;
ganlikun 0:20e0c61e0684 84 }
ganlikun 0:20e0c61e0684 85 #endif
ganlikun 0:20e0c61e0684 86 #if defined(ADC2)
ganlikun 0:20e0c61e0684 87 if (((ADCName)obj->handle.Instance == ADC_2) && adc2_inited) return;
ganlikun 0:20e0c61e0684 88 if ((ADCName)obj->handle.Instance == ADC_2) {
ganlikun 0:20e0c61e0684 89 __HAL_RCC_ADC2_CLK_ENABLE();
ganlikun 0:20e0c61e0684 90 adc2_inited = 1;
ganlikun 0:20e0c61e0684 91 }
ganlikun 0:20e0c61e0684 92 #endif
ganlikun 0:20e0c61e0684 93 #if defined(ADC3)
ganlikun 0:20e0c61e0684 94 if (((ADCName)obj->handle.Instance == ADC_3) && adc3_inited) return;
ganlikun 0:20e0c61e0684 95 if ((ADCName)obj->handle.Instance == ADC_3) {
ganlikun 0:20e0c61e0684 96 __HAL_RCC_ADC3_CLK_ENABLE();
ganlikun 0:20e0c61e0684 97 adc3_inited = 1;
ganlikun 0:20e0c61e0684 98 }
ganlikun 0:20e0c61e0684 99 #endif
ganlikun 0:20e0c61e0684 100 // Configure ADC
ganlikun 0:20e0c61e0684 101 obj->handle.State = HAL_ADC_STATE_RESET;
ganlikun 0:20e0c61e0684 102 obj->handle.Init.ClockPrescaler = ADC_CLOCK_SYNC_PCLK_DIV2;
ganlikun 0:20e0c61e0684 103 obj->handle.Init.Resolution = ADC_RESOLUTION_12B;
ganlikun 0:20e0c61e0684 104 obj->handle.Init.ScanConvMode = DISABLE;
ganlikun 0:20e0c61e0684 105 obj->handle.Init.ContinuousConvMode = DISABLE;
ganlikun 0:20e0c61e0684 106 obj->handle.Init.DiscontinuousConvMode = DISABLE;
ganlikun 0:20e0c61e0684 107 obj->handle.Init.NbrOfDiscConversion = 0;
ganlikun 0:20e0c61e0684 108 obj->handle.Init.ExternalTrigConvEdge = ADC_EXTERNALTRIGCONVEDGE_NONE;
ganlikun 0:20e0c61e0684 109 obj->handle.Init.ExternalTrigConv = ADC_EXTERNALTRIGCONV_T1_CC1;
ganlikun 0:20e0c61e0684 110 obj->handle.Init.DataAlign = ADC_DATAALIGN_RIGHT;
ganlikun 0:20e0c61e0684 111 obj->handle.Init.NbrOfConversion = 1;
ganlikun 0:20e0c61e0684 112 obj->handle.Init.DMAContinuousRequests = DISABLE;
ganlikun 0:20e0c61e0684 113 obj->handle.Init.EOCSelection = DISABLE;
ganlikun 0:20e0c61e0684 114
ganlikun 0:20e0c61e0684 115 if (HAL_ADC_Init(&obj->handle) != HAL_OK) {
ganlikun 0:20e0c61e0684 116 error("Cannot initialize ADC\n");
ganlikun 0:20e0c61e0684 117 }
ganlikun 0:20e0c61e0684 118 }
ganlikun 0:20e0c61e0684 119
ganlikun 0:20e0c61e0684 120 static inline uint16_t adc_read(analogin_t *obj)
ganlikun 0:20e0c61e0684 121 {
ganlikun 0:20e0c61e0684 122 ADC_ChannelConfTypeDef sConfig = {0};
ganlikun 0:20e0c61e0684 123
ganlikun 0:20e0c61e0684 124 // Configure ADC channel
ganlikun 0:20e0c61e0684 125 sConfig.Rank = 1;
ganlikun 0:20e0c61e0684 126 sConfig.SamplingTime = ADC_SAMPLETIME_15CYCLES;
ganlikun 0:20e0c61e0684 127 sConfig.Offset = 0;
ganlikun 0:20e0c61e0684 128
ganlikun 0:20e0c61e0684 129 switch (obj->channel) {
ganlikun 0:20e0c61e0684 130 case 0:
ganlikun 0:20e0c61e0684 131 sConfig.Channel = ADC_CHANNEL_0;
ganlikun 0:20e0c61e0684 132 break;
ganlikun 0:20e0c61e0684 133 case 1:
ganlikun 0:20e0c61e0684 134 sConfig.Channel = ADC_CHANNEL_1;
ganlikun 0:20e0c61e0684 135 break;
ganlikun 0:20e0c61e0684 136 case 2:
ganlikun 0:20e0c61e0684 137 sConfig.Channel = ADC_CHANNEL_2;
ganlikun 0:20e0c61e0684 138 break;
ganlikun 0:20e0c61e0684 139 case 3:
ganlikun 0:20e0c61e0684 140 sConfig.Channel = ADC_CHANNEL_3;
ganlikun 0:20e0c61e0684 141 break;
ganlikun 0:20e0c61e0684 142 case 4:
ganlikun 0:20e0c61e0684 143 sConfig.Channel = ADC_CHANNEL_4;
ganlikun 0:20e0c61e0684 144 break;
ganlikun 0:20e0c61e0684 145 case 5:
ganlikun 0:20e0c61e0684 146 sConfig.Channel = ADC_CHANNEL_5;
ganlikun 0:20e0c61e0684 147 break;
ganlikun 0:20e0c61e0684 148 case 6:
ganlikun 0:20e0c61e0684 149 sConfig.Channel = ADC_CHANNEL_6;
ganlikun 0:20e0c61e0684 150 break;
ganlikun 0:20e0c61e0684 151 case 7:
ganlikun 0:20e0c61e0684 152 sConfig.Channel = ADC_CHANNEL_7;
ganlikun 0:20e0c61e0684 153 break;
ganlikun 0:20e0c61e0684 154 case 8:
ganlikun 0:20e0c61e0684 155 sConfig.Channel = ADC_CHANNEL_8;
ganlikun 0:20e0c61e0684 156 break;
ganlikun 0:20e0c61e0684 157 case 9:
ganlikun 0:20e0c61e0684 158 sConfig.Channel = ADC_CHANNEL_9;
ganlikun 0:20e0c61e0684 159 break;
ganlikun 0:20e0c61e0684 160 case 10:
ganlikun 0:20e0c61e0684 161 sConfig.Channel = ADC_CHANNEL_10;
ganlikun 0:20e0c61e0684 162 break;
ganlikun 0:20e0c61e0684 163 case 11:
ganlikun 0:20e0c61e0684 164 sConfig.Channel = ADC_CHANNEL_11;
ganlikun 0:20e0c61e0684 165 break;
ganlikun 0:20e0c61e0684 166 case 12:
ganlikun 0:20e0c61e0684 167 sConfig.Channel = ADC_CHANNEL_12;
ganlikun 0:20e0c61e0684 168 break;
ganlikun 0:20e0c61e0684 169 case 13:
ganlikun 0:20e0c61e0684 170 sConfig.Channel = ADC_CHANNEL_13;
ganlikun 0:20e0c61e0684 171 break;
ganlikun 0:20e0c61e0684 172 case 14:
ganlikun 0:20e0c61e0684 173 sConfig.Channel = ADC_CHANNEL_14;
ganlikun 0:20e0c61e0684 174 break;
ganlikun 0:20e0c61e0684 175 case 15:
ganlikun 0:20e0c61e0684 176 sConfig.Channel = ADC_CHANNEL_15;
ganlikun 0:20e0c61e0684 177 break;
ganlikun 0:20e0c61e0684 178 case 16:
ganlikun 0:20e0c61e0684 179 sConfig.Channel = ADC_CHANNEL_TEMPSENSOR;
ganlikun 0:20e0c61e0684 180 break;
ganlikun 0:20e0c61e0684 181 case 17:
ganlikun 0:20e0c61e0684 182 sConfig.Channel = ADC_CHANNEL_VREFINT;
ganlikun 0:20e0c61e0684 183 /* From experiment, measurement needs max sampling time to be valid */
ganlikun 0:20e0c61e0684 184 sConfig.SamplingTime = ADC_SAMPLETIME_480CYCLES;
ganlikun 0:20e0c61e0684 185 break;
ganlikun 0:20e0c61e0684 186 case 18:
ganlikun 0:20e0c61e0684 187 sConfig.Channel = ADC_CHANNEL_VBAT;
ganlikun 0:20e0c61e0684 188 /* From experiment, measurement needs max sampling time to be valid */
ganlikun 0:20e0c61e0684 189 sConfig.SamplingTime = ADC_SAMPLETIME_480CYCLES;
ganlikun 0:20e0c61e0684 190 break;
ganlikun 0:20e0c61e0684 191 default:
ganlikun 0:20e0c61e0684 192 return 0;
ganlikun 0:20e0c61e0684 193 }
ganlikun 0:20e0c61e0684 194
ganlikun 0:20e0c61e0684 195 // Measuring VBAT sets the ADC_CCR_VBATE bit in ADC->CCR, and there is not
ganlikun 0:20e0c61e0684 196 // possibility with the ST HAL driver to clear it. If it isn't cleared,
ganlikun 0:20e0c61e0684 197 // VBAT remains connected to the ADC channel in preference to temperature,
ganlikun 0:20e0c61e0684 198 // so VBAT readings are returned in place of temperature.
ganlikun 0:20e0c61e0684 199 ADC->CCR &= ~(ADC_CCR_VBATE | ADC_CCR_TSVREFE);
ganlikun 0:20e0c61e0684 200
ganlikun 0:20e0c61e0684 201 HAL_ADC_ConfigChannel(&obj->handle, &sConfig);
ganlikun 0:20e0c61e0684 202
ganlikun 0:20e0c61e0684 203 HAL_ADC_Start(&obj->handle); // Start conversion
ganlikun 0:20e0c61e0684 204
ganlikun 0:20e0c61e0684 205 // Wait end of conversion and get value
ganlikun 0:20e0c61e0684 206 if (HAL_ADC_PollForConversion(&obj->handle, 10) == HAL_OK) {
ganlikun 0:20e0c61e0684 207 return (uint16_t)HAL_ADC_GetValue(&obj->handle);
ganlikun 0:20e0c61e0684 208 } else {
ganlikun 0:20e0c61e0684 209 return 0;
ganlikun 0:20e0c61e0684 210 }
ganlikun 0:20e0c61e0684 211 }
ganlikun 0:20e0c61e0684 212
ganlikun 0:20e0c61e0684 213 uint16_t analogin_read_u16(analogin_t *obj)
ganlikun 0:20e0c61e0684 214 {
ganlikun 0:20e0c61e0684 215 uint16_t value = adc_read(obj);
ganlikun 0:20e0c61e0684 216 // 12-bit to 16-bit conversion
ganlikun 0:20e0c61e0684 217 value = ((value << 4) & (uint16_t)0xFFF0) | ((value >> 8) & (uint16_t)0x000F);
ganlikun 0:20e0c61e0684 218 return value;
ganlikun 0:20e0c61e0684 219 }
ganlikun 0:20e0c61e0684 220
ganlikun 0:20e0c61e0684 221 float analogin_read(analogin_t *obj)
ganlikun 0:20e0c61e0684 222 {
ganlikun 0:20e0c61e0684 223 uint16_t value = adc_read(obj);
ganlikun 0:20e0c61e0684 224 return (float)value * (1.0f / (float)0xFFF); // 12 bits range
ganlikun 0:20e0c61e0684 225 }
ganlikun 0:20e0c61e0684 226
ganlikun 0:20e0c61e0684 227 #endif
ganlikun 0:20e0c61e0684 228