PHung Tung / DISCO-F746_WAV_PLAYER

SPKT

Dependencies:   F746_GUI SD_PlayerSkeleton F746_SAI_IO

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

Committer:
phungductung
Date:
Tue Jun 04 21:37:21 2019 +0000
Revision:
0:8ede47d38d10
SPKT

Who changed what in which revision?

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