From 613af0f6041135a72dafc23f81a77a0c7a4edd2a Mon Sep 17 00:00:00 2001 From: George Beckstein Date: Thu, 20 Feb 2020 12:31:42 -0500 Subject: [PATCH] Added support for ANALOGOUT --- .../TARGET_STM32G4/analogout_device.c | 169 ++++++++++++++++++ targets/targets.json | 1 + 2 files changed, 170 insertions(+) create mode 100644 targets/TARGET_STM/TARGET_STM32G4/analogout_device.c diff --git a/targets/TARGET_STM/TARGET_STM32G4/analogout_device.c b/targets/TARGET_STM/TARGET_STM32G4/analogout_device.c new file mode 100644 index 0000000000..7ee22c2caa --- /dev/null +++ b/targets/TARGET_STM/TARGET_STM32G4/analogout_device.c @@ -0,0 +1,169 @@ +/* mbed Microcontroller Library + * Copyright (c) 2015, 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 "analogout_api.h" + +#if DEVICE_ANALOGOUT + +#include "cmsis.h" +#include "pinmap.h" +#include "mbed_error.h" +#include "PeripheralPins.h" + +// These variables are used for the "free" function +static int pa4_used = 0; +static int pa5_used = 0; + +#if STATIC_PINMAP_READY +#define ANALOGOUT_INIT_DIRECT analogout_init_direct +void analogout_init_direct(dac_t *obj, const PinMap *pinmap) +#else +#define ANALOGOUT_INIT_DIRECT _analogout_init_direct +static void _analogout_init_direct(dac_t *obj, const PinMap *pinmap) +#endif +{ + DAC_ChannelConfTypeDef sConfig = {0}; + + // Get the peripheral name from the pin and assign it to the object + obj->dac = (DACName)pinmap->peripheral; + MBED_ASSERT(obj->dac != (DACName)NC); + + // Get the pin function and assign the used channel to the object + uint32_t function = (uint32_t)pinmap->function; + MBED_ASSERT(function != (uint32_t)NC); + + // Save the channel for the write and read functions + switch (STM_PIN_CHANNEL(function)) { + case 1: + obj->channel = DAC_CHANNEL_1; + break; +#if defined(DAC_CHANNEL_2) + case 2: + obj->channel = DAC_CHANNEL_2; + break; +#endif + default: + error("Unknown DAC channel"); + break; + } + + // Configure GPIO + pin_function(pinmap->pin, pinmap->function); + pin_mode(pinmap->pin, PullNone); + + // Save the pin for future use + obj->pin = pinmap->pin; + + // Enable DAC clock + if (obj->dac == DAC_1) { + __HAL_RCC_DAC1_CLK_ENABLE(); + } +#if defined(DAC2) + if (obj->dac == DAC_2) { + __HAL_RCC_DAC2_CLK_ENABLE(); + } +#endif + + // Configure DAC + obj->handle.Instance = (DAC_TypeDef *)(obj->dac); + obj->handle.State = HAL_DAC_STATE_RESET; + + if (HAL_DAC_Init(&obj->handle) != HAL_OK) { + error("HAL_DAC_Init failed"); + } + + /* Enable both Buffer and Switch in the configuration, + * letting HAL layer in charge of selecting either one + * or the other depending on the actual DAC instance and + * channel being configured. + */ + sConfig.DAC_Trigger = DAC_TRIGGER_NONE; + sConfig.DAC_OutputBuffer = DAC_OUTPUTBUFFER_ENABLE; +#if defined(DAC_OUTPUTSWITCH_ENABLE) + sConfig.DAC_OutputSwitch = DAC_OUTPUTSWITCH_ENABLE; +#endif + + if (pinmap->pin == PA_4) { + pa4_used = 1; + } + + if (pinmap->pin == PA_5) { + pa5_used = 1; + } + + if (HAL_DAC_ConfigChannel(&obj->handle, &sConfig, obj->channel) != HAL_OK) { + error("HAL_DAC_ConfigChannel failed"); + } + + analogout_write_u16(obj, 0); +} + +void analogout_init(dac_t *obj, PinName pin) +{ + int peripheral = (int)pinmap_peripheral(pin, PinMap_DAC); + int function = (int)pinmap_find_function(pin, PinMap_DAC); + + const PinMap static_pinmap = {pin, peripheral, function}; + + ANALOGOUT_INIT_DIRECT(obj, &static_pinmap); +} + +void analogout_free(dac_t *obj) +{ + // Reset DAC and disable clock + if (obj->pin == PA_4) { + pa4_used = 0; + } + if (obj->pin == PA_5) { + pa5_used = 0; + } + + if ((pa4_used == 0) && (pa5_used == 0)) { + __HAL_RCC_DAC1_FORCE_RESET(); + __HAL_RCC_DAC1_RELEASE_RESET(); + __HAL_RCC_DAC1_CLK_DISABLE(); + } + +#if defined(DAC2) + if (obj->pin == PA_6) { + __HAL_RCC_DAC2_FORCE_RESET(); + __HAL_RCC_DAC2_RELEASE_RESET(); + __HAL_RCC_DAC2_CLK_DISABLE(); + } +#endif + + // Configure GPIO + pin_function(obj->pin, STM_PIN_DATA(STM_MODE_INPUT, GPIO_NOPULL, 0)); +} + +const PinMap *analogout_pinmap() +{ + return PinMap_DAC; +} + +#endif // DEVICE_ANALOGOUT diff --git a/targets/targets.json b/targets/targets.json index edb6892dcb..921f474b11 100644 --- a/targets/targets.json +++ b/targets/targets.json @@ -7559,6 +7559,7 @@ "lpticker_delay_ticks": 0 }, "device_has_add": [ + "ANALOGOUT", "FLASH", "MPU" ],