Gan likun
00
Diff: targets/TARGET_STM/TARGET_STM32F4/analogin_api.c
- Revision:
- 0:13413ea9a877
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/targets/TARGET_STM/TARGET_STM32F4/analogin_api.c Sun Jun 12 14:02:44 2022 +0000
@@ -0,0 +1,228 @@
+/* mbed Microcontroller Library
+ * Copyright (c) 2016, STMicroelectronics
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * 1. Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright notice,
+ * this list of conditions and the following disclaimer in the documentation
+ * and/or other materials provided with the distribution.
+ * 3. Neither the name of STMicroelectronics nor the names of its contributors
+ * may be used to endorse or promote products derived from this software
+ * without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+ * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ */
+#include "mbed_assert.h"
+#include "analogin_api.h"
+
+#if DEVICE_ANALOGIN
+
+#include "mbed_wait_api.h"
+#include "cmsis.h"
+#include "pinmap.h"
+#include "mbed_error.h"
+#include "PeripheralPins.h"
+
+void analogin_init(analogin_t *obj, PinName pin)
+{
+ uint32_t function = (uint32_t)NC;
+
+#if defined(ADC1)
+ static int adc1_inited = 0;
+#endif
+#if defined(ADC2)
+ static int adc2_inited = 0;
+#endif
+#if defined(ADC3)
+ static int adc3_inited = 0;
+#endif
+ // ADC Internal Channels "pins" (Temperature, Vref, Vbat, ...)
+ // are described in PinNames.h and PeripheralPins.c
+ // Pin value must be between 0xF0 and 0xFF
+ if ((pin < 0xF0) || (pin >= 0x100)) {
+ // Normal channels
+ // Get the peripheral name from the pin and assign it to the object
+ obj->handle.Instance = (ADC_TypeDef *) pinmap_peripheral(pin, PinMap_ADC);
+ // Get the functions (adc channel) from the pin and assign it to the object
+ function = pinmap_function(pin, PinMap_ADC);
+ // Configure GPIO
+ pinmap_pinout(pin, PinMap_ADC);
+ } else {
+ // Internal channels
+ obj->handle.Instance = (ADC_TypeDef *) pinmap_peripheral(pin, PinMap_ADC_Internal);
+ function = pinmap_function(pin, PinMap_ADC_Internal);
+ // No GPIO configuration for internal channels
+ }
+ MBED_ASSERT(obj->handle.Instance != (ADC_TypeDef *)NC);
+ MBED_ASSERT(function != (uint32_t)NC);
+
+ obj->channel = STM_PIN_CHANNEL(function);
+
+ // Save pin number for the read function
+ obj->pin = pin;
+
+ // Check if ADC is already initialized
+ // Enable ADC clock
+#if defined(ADC1)
+ if (((ADCName)obj->handle.Instance == ADC_1) && adc1_inited) return;
+ if ((ADCName)obj->handle.Instance == ADC_1) {
+ __HAL_RCC_ADC1_CLK_ENABLE();
+ adc1_inited = 1;
+ }
+#endif
+#if defined(ADC2)
+ if (((ADCName)obj->handle.Instance == ADC_2) && adc2_inited) return;
+ if ((ADCName)obj->handle.Instance == ADC_2) {
+ __HAL_RCC_ADC2_CLK_ENABLE();
+ adc2_inited = 1;
+ }
+#endif
+#if defined(ADC3)
+ if (((ADCName)obj->handle.Instance == ADC_3) && adc3_inited) return;
+ if ((ADCName)obj->handle.Instance == ADC_3) {
+ __HAL_RCC_ADC3_CLK_ENABLE();
+ adc3_inited = 1;
+ }
+#endif
+ // Configure ADC
+ obj->handle.State = HAL_ADC_STATE_RESET;
+ obj->handle.Init.ClockPrescaler = ADC_CLOCK_SYNC_PCLK_DIV2;
+ obj->handle.Init.Resolution = ADC_RESOLUTION_12B;
+ obj->handle.Init.ScanConvMode = DISABLE;
+ obj->handle.Init.ContinuousConvMode = DISABLE;
+ obj->handle.Init.DiscontinuousConvMode = DISABLE;
+ obj->handle.Init.NbrOfDiscConversion = 0;
+ obj->handle.Init.ExternalTrigConvEdge = ADC_EXTERNALTRIGCONVEDGE_NONE;
+ obj->handle.Init.ExternalTrigConv = ADC_EXTERNALTRIGCONV_T1_CC1;
+ obj->handle.Init.DataAlign = ADC_DATAALIGN_RIGHT;
+ obj->handle.Init.NbrOfConversion = 1;
+ obj->handle.Init.DMAContinuousRequests = DISABLE;
+ obj->handle.Init.EOCSelection = DISABLE;
+
+ if (HAL_ADC_Init(&obj->handle) != HAL_OK) {
+ error("Cannot initialize ADC\n");
+ }
+}
+
+static inline uint16_t adc_read(analogin_t *obj)
+{
+ ADC_ChannelConfTypeDef sConfig = {0};
+
+ // Configure ADC channel
+ sConfig.Rank = 1;
+ sConfig.SamplingTime = ADC_SAMPLETIME_15CYCLES;
+ sConfig.Offset = 0;
+
+ switch (obj->channel) {
+ case 0:
+ sConfig.Channel = ADC_CHANNEL_0;
+ break;
+ case 1:
+ sConfig.Channel = ADC_CHANNEL_1;
+ break;
+ case 2:
+ sConfig.Channel = ADC_CHANNEL_2;
+ break;
+ case 3:
+ sConfig.Channel = ADC_CHANNEL_3;
+ break;
+ case 4:
+ sConfig.Channel = ADC_CHANNEL_4;
+ break;
+ case 5:
+ sConfig.Channel = ADC_CHANNEL_5;
+ break;
+ case 6:
+ sConfig.Channel = ADC_CHANNEL_6;
+ break;
+ case 7:
+ sConfig.Channel = ADC_CHANNEL_7;
+ break;
+ case 8:
+ sConfig.Channel = ADC_CHANNEL_8;
+ break;
+ case 9:
+ sConfig.Channel = ADC_CHANNEL_9;
+ break;
+ case 10:
+ sConfig.Channel = ADC_CHANNEL_10;
+ break;
+ case 11:
+ sConfig.Channel = ADC_CHANNEL_11;
+ break;
+ case 12:
+ sConfig.Channel = ADC_CHANNEL_12;
+ break;
+ case 13:
+ sConfig.Channel = ADC_CHANNEL_13;
+ break;
+ case 14:
+ sConfig.Channel = ADC_CHANNEL_14;
+ break;
+ case 15:
+ sConfig.Channel = ADC_CHANNEL_15;
+ break;
+ case 16:
+ sConfig.Channel = ADC_CHANNEL_TEMPSENSOR;
+ break;
+ case 17:
+ sConfig.Channel = ADC_CHANNEL_VREFINT;
+ /* From experiment, measurement needs max sampling time to be valid */
+ sConfig.SamplingTime = ADC_SAMPLETIME_480CYCLES;
+ break;
+ case 18:
+ sConfig.Channel = ADC_CHANNEL_VBAT;
+ /* From experiment, measurement needs max sampling time to be valid */
+ sConfig.SamplingTime = ADC_SAMPLETIME_480CYCLES;
+ break;
+ default:
+ return 0;
+ }
+
+ // Measuring VBAT sets the ADC_CCR_VBATE bit in ADC->CCR, and there is not
+ // possibility with the ST HAL driver to clear it. If it isn't cleared,
+ // VBAT remains connected to the ADC channel in preference to temperature,
+ // so VBAT readings are returned in place of temperature.
+ ADC->CCR &= ~(ADC_CCR_VBATE | ADC_CCR_TSVREFE);
+
+ HAL_ADC_ConfigChannel(&obj->handle, &sConfig);
+
+ HAL_ADC_Start(&obj->handle); // Start conversion
+
+ // Wait end of conversion and get value
+ if (HAL_ADC_PollForConversion(&obj->handle, 10) == HAL_OK) {
+ return (uint16_t)HAL_ADC_GetValue(&obj->handle);
+ } else {
+ return 0;
+ }
+}
+
+uint16_t analogin_read_u16(analogin_t *obj)
+{
+ uint16_t value = adc_read(obj);
+ // 12-bit to 16-bit conversion
+ value = ((value << 4) & (uint16_t)0xFFF0) | ((value >> 8) & (uint16_t)0x000F);
+ return value;
+}
+
+float analogin_read(analogin_t *obj)
+{
+ uint16_t value = adc_read(obj);
+ return (float)value * (1.0f / (float)0xFFF); // 12 bits range
+}
+
+#endif
+