STM32WL : ANALOGOUT full support

Author: jeromecoutant

targets/TARGET_STM/TARGET_STM32WL/analogout_device.c

@@ -23,43 +23,88 @@
 #include "mbed_error.h"
 #include "PeripheralPins.h"
 
-DAC_HandleTypeDef hdac;
+#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);
+
+    switch (STM_PIN_CHANNEL(function)) {
+        case 1:
+            obj->channel = DAC_CHANNEL_1;
+            break;
+        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
+    __HAL_RCC_DAC_CLK_ENABLE();
+
+    // Configure DAC
+    obj->handle.Instance = DAC;
+    obj->handle.State = HAL_DAC_STATE_RESET;
+
+    if (HAL_DAC_Init(&obj->handle) != HAL_OK) {
+        error("HAL_DAC_Init failed");
+    }
+
+    sConfig.DAC_Trigger = DAC_TRIGGER_NONE;
+    sConfig.DAC_OutputBuffer = DAC_OUTPUTBUFFER_ENABLE;
+    sConfig.DAC_ConnectOnChipPeripheral = DAC_CHIPCONNECT_DISABLE;
+    sConfig.DAC_UserTrimming = DAC_TRIMMING_FACTORY;
+
+    sConfig.DAC_SampleAndHold = DAC_SAMPLEANDHOLD_DISABLE;
+
+    if (HAL_DAC_ConfigChannel(&obj->handle, &sConfig, obj->channel) != HAL_OK) {
+        error("Cannot configure DAC channel\n");
+    }
+
+    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};
 
-  DAC_ChannelConfTypeDef sConfig = {0};
-  
-  /* obj Initialization */
-  obj->dac = (DACName)NC;
-  
-  obj->pin = pin;
- 
-  obj->channel = DAC_CHANNEL_1;
-
-  /* DAC Initialization */
-  hdac.Instance = DAC;
-  if (HAL_DAC_Init(&hdac) != HAL_OK)
-  {
-    //Error_Handler();
-  }
-  /** DAC channel OUT1 config
-  */
-  sConfig.DAC_SampleAndHold = DAC_SAMPLEANDHOLD_DISABLE;
-  sConfig.DAC_Trigger = DAC_TRIGGER_T1_TRGO;
-  sConfig.DAC_OutputBuffer = DAC_OUTPUTBUFFER_ENABLE;
-  sConfig.DAC_ConnectOnChipPeripheral = DAC_CHIPCONNECT_DISABLE;
-  sConfig.DAC_UserTrimming = DAC_TRIMMING_FACTORY;
-  
-  if (HAL_DAC_ConfigChannel(&hdac, &sConfig, DAC_CHANNEL_1) != HAL_OK)
-  {
-    //Error_Handler();
-  }
-  
+    ANALOGOUT_INIT_DIRECT(obj, &static_pinmap);
+}
+
+void analogout_free(dac_t *obj)
+{
+    __HAL_RCC_DAC_FORCE_RESET();
+    __HAL_RCC_DAC_RELEASE_RESET();
+    __HAL_RCC_DAC_CLK_DISABLE();
+
+    // Configure GPIO
+    pin_function(obj->pin, STM_PIN_DATA(STM_MODE_INPUT, GPIO_NOPULL, 0));
 }
 
 const PinMap *analogout_pinmap()
 {
     return PinMap_DAC;
 }
-#endif
+
+#endif // DEVICE_ANALOGOUT