PHung Tung / SRC_STM32F7

SPKT

Dependents:   WAV

targets/hal/TARGET_STM/TARGET_STM32F7/analogin_api.c@0:e87aa4c49e95, 2019-06-04 (annotated)

Committer:
phungductung
Date:
Tue Jun 04 21:51:46 2019 +0000
Revision:
0:e87aa4c49e95
libray

Who changed what in which revision?

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