Krzysztof Sitko / mbed-dev-STM32F031K6

Fork of mbed-dev by mbed official

Committer:
mbed_official
Date:
Mon Oct 26 09:00:10 2015 +0000
Revision:
8:69ce7aaad4c4
Parent:
0:9b334a45a8ff
Synchronized with git revision 22ef4124357e8536842581c7afd8e0c2c7858d6f

Full URL: https://github.com/mbedmicro/mbed/commit/22ef4124357e8536842581c7afd8e0c2c7858d6f/

STM32xx -Fix analog_out issue with 12 to 16bits conversion

Who changed what in which revision?

UserRevisionLine numberNew contents of line
bogdanm 0:9b334a45a8ff 1 /* mbed Microcontroller Library
bogdanm 0:9b334a45a8ff 2 * Copyright (c) 2015, STMicroelectronics
bogdanm 0:9b334a45a8ff 3 * All rights reserved.
bogdanm 0:9b334a45a8ff 4 *
bogdanm 0:9b334a45a8ff 5 * Redistribution and use in source and binary forms, with or without
bogdanm 0:9b334a45a8ff 6 * modification, are permitted provided that the following conditions are met:
bogdanm 0:9b334a45a8ff 7 *
bogdanm 0:9b334a45a8ff 8 * 1. Redistributions of source code must retain the above copyright notice,
bogdanm 0:9b334a45a8ff 9 * this list of conditions and the following disclaimer.
bogdanm 0:9b334a45a8ff 10 * 2. Redistributions in binary form must reproduce the above copyright notice,
bogdanm 0:9b334a45a8ff 11 * this list of conditions and the following disclaimer in the documentation
bogdanm 0:9b334a45a8ff 12 * and/or other materials provided with the distribution.
bogdanm 0:9b334a45a8ff 13 * 3. Neither the name of STMicroelectronics nor the names of its contributors
bogdanm 0:9b334a45a8ff 14 * may be used to endorse or promote products derived from this software
bogdanm 0:9b334a45a8ff 15 * without specific prior written permission.
bogdanm 0:9b334a45a8ff 16 *
bogdanm 0:9b334a45a8ff 17 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
bogdanm 0:9b334a45a8ff 18 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
bogdanm 0:9b334a45a8ff 19 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
bogdanm 0:9b334a45a8ff 20 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
bogdanm 0:9b334a45a8ff 21 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
bogdanm 0:9b334a45a8ff 22 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
bogdanm 0:9b334a45a8ff 23 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
bogdanm 0:9b334a45a8ff 24 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
bogdanm 0:9b334a45a8ff 25 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
bogdanm 0:9b334a45a8ff 26 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
bogdanm 0:9b334a45a8ff 27 */
bogdanm 0:9b334a45a8ff 28 #include "mbed_assert.h"
bogdanm 0:9b334a45a8ff 29 #include "analogout_api.h"
bogdanm 0:9b334a45a8ff 30
bogdanm 0:9b334a45a8ff 31 #if DEVICE_ANALOGOUT
bogdanm 0:9b334a45a8ff 32
bogdanm 0:9b334a45a8ff 33 #include "cmsis.h"
bogdanm 0:9b334a45a8ff 34 #include "pinmap.h"
bogdanm 0:9b334a45a8ff 35 #include "mbed_error.h"
bogdanm 0:9b334a45a8ff 36 #include "PeripheralPins.h"
bogdanm 0:9b334a45a8ff 37
bogdanm 0:9b334a45a8ff 38 #define DAC_RANGE (0xFFF) // 12 bits
mbed_official 8:69ce7aaad4c4 39 #define DAC_NB_BITS (12)
bogdanm 0:9b334a45a8ff 40
bogdanm 0:9b334a45a8ff 41 static DAC_HandleTypeDef DacHandle;
bogdanm 0:9b334a45a8ff 42
bogdanm 0:9b334a45a8ff 43 // These variables are used for the "free" function
bogdanm 0:9b334a45a8ff 44 static int channel1_used = 0;
bogdanm 0:9b334a45a8ff 45 static int channel2_used = 0;
bogdanm 0:9b334a45a8ff 46
mbed_official 8:69ce7aaad4c4 47 void analogout_init(dac_t *obj, PinName pin) {
bogdanm 0:9b334a45a8ff 48 DAC_ChannelConfTypeDef sConfig = {0};
bogdanm 0:9b334a45a8ff 49
bogdanm 0:9b334a45a8ff 50 // Get the peripheral name from the pin and assign it to the object
bogdanm 0:9b334a45a8ff 51 obj->dac = (DACName)pinmap_peripheral(pin, PinMap_DAC);
bogdanm 0:9b334a45a8ff 52 MBED_ASSERT(obj->dac != (DACName)NC);
bogdanm 0:9b334a45a8ff 53
bogdanm 0:9b334a45a8ff 54 // Get the pin function and assign the used channel to the object
bogdanm 0:9b334a45a8ff 55 uint32_t function = pinmap_function(pin, PinMap_DAC);
bogdanm 0:9b334a45a8ff 56 MBED_ASSERT(function != (uint32_t)NC);
bogdanm 0:9b334a45a8ff 57 obj->channel = STM_PIN_CHANNEL(function);
bogdanm 0:9b334a45a8ff 58
bogdanm 0:9b334a45a8ff 59 // Configure GPIO
bogdanm 0:9b334a45a8ff 60 pinmap_pinout(pin, PinMap_DAC);
bogdanm 0:9b334a45a8ff 61
bogdanm 0:9b334a45a8ff 62 // Save the pin for future use
bogdanm 0:9b334a45a8ff 63 obj->pin = pin;
bogdanm 0:9b334a45a8ff 64
bogdanm 0:9b334a45a8ff 65 // Enable DAC clock
bogdanm 0:9b334a45a8ff 66 __HAL_RCC_DAC1_CLK_ENABLE();
bogdanm 0:9b334a45a8ff 67
bogdanm 0:9b334a45a8ff 68 // Configure DAC
bogdanm 0:9b334a45a8ff 69 DacHandle.Instance = DAC;
bogdanm 0:9b334a45a8ff 70
bogdanm 0:9b334a45a8ff 71 if (HAL_DAC_Init(&DacHandle) != HAL_OK) {
bogdanm 0:9b334a45a8ff 72 error("Cannot initialize DAC\n");
bogdanm 0:9b334a45a8ff 73 }
bogdanm 0:9b334a45a8ff 74
bogdanm 0:9b334a45a8ff 75 sConfig.DAC_SampleAndHold = DAC_SAMPLEANDHOLD_DISABLE;
bogdanm 0:9b334a45a8ff 76 sConfig.DAC_Trigger = DAC_TRIGGER_NONE;
bogdanm 0:9b334a45a8ff 77 sConfig.DAC_OutputBuffer = DAC_OUTPUTBUFFER_ENABLE;
bogdanm 0:9b334a45a8ff 78 sConfig.DAC_ConnectOnChipPeripheral = DAC_CHIPCONNECT_DISABLE;
bogdanm 0:9b334a45a8ff 79 sConfig.DAC_UserTrimming = DAC_TRIMMING_FACTORY;
bogdanm 0:9b334a45a8ff 80
bogdanm 0:9b334a45a8ff 81 if (obj->channel == 2) {
bogdanm 0:9b334a45a8ff 82 if (HAL_DAC_ConfigChannel(&DacHandle, &sConfig, DAC_CHANNEL_2) != HAL_OK) {
bogdanm 0:9b334a45a8ff 83 error("Cannot configure DAC channel 2\n");
bogdanm 0:9b334a45a8ff 84 }
bogdanm 0:9b334a45a8ff 85 channel2_used = 1;
bogdanm 0:9b334a45a8ff 86 } else { // channel 1 per default
bogdanm 0:9b334a45a8ff 87 if (HAL_DAC_ConfigChannel(&DacHandle, &sConfig, DAC_CHANNEL_1) != HAL_OK) {
bogdanm 0:9b334a45a8ff 88 error("Cannot configure DAC channel 1\n");
bogdanm 0:9b334a45a8ff 89 }
bogdanm 0:9b334a45a8ff 90 obj->channel = 1;
bogdanm 0:9b334a45a8ff 91 channel1_used = 1;
bogdanm 0:9b334a45a8ff 92 }
bogdanm 0:9b334a45a8ff 93
bogdanm 0:9b334a45a8ff 94 analogout_write_u16(obj, 0);
bogdanm 0:9b334a45a8ff 95 }
bogdanm 0:9b334a45a8ff 96
mbed_official 8:69ce7aaad4c4 97 void analogout_free(dac_t *obj) {
bogdanm 0:9b334a45a8ff 98 // Reset DAC and disable clock
bogdanm 0:9b334a45a8ff 99 if (obj->channel == 1) channel1_used = 0;
bogdanm 0:9b334a45a8ff 100 if (obj->channel == 2) channel2_used = 0;
bogdanm 0:9b334a45a8ff 101
bogdanm 0:9b334a45a8ff 102 if ((channel1_used == 0) && (channel2_used == 0)) {
bogdanm 0:9b334a45a8ff 103 __HAL_RCC_DAC1_FORCE_RESET();
bogdanm 0:9b334a45a8ff 104 __HAL_RCC_DAC1_RELEASE_RESET();
bogdanm 0:9b334a45a8ff 105 __HAL_RCC_DAC1_CLK_DISABLE();
bogdanm 0:9b334a45a8ff 106 }
bogdanm 0:9b334a45a8ff 107
bogdanm 0:9b334a45a8ff 108 // Configure GPIO
bogdanm 0:9b334a45a8ff 109 pin_function(obj->pin, STM_PIN_DATA(STM_MODE_INPUT, GPIO_NOPULL, 0));
bogdanm 0:9b334a45a8ff 110 }
bogdanm 0:9b334a45a8ff 111
mbed_official 8:69ce7aaad4c4 112 static inline void dac_write(dac_t *obj, int value) {
bogdanm 0:9b334a45a8ff 113 if (obj->channel == 1) {
mbed_official 8:69ce7aaad4c4 114 HAL_DAC_SetValue(&DacHandle, DAC_CHANNEL_1, DAC_ALIGN_12B_R, (value & DAC_RANGE));
bogdanm 0:9b334a45a8ff 115 HAL_DAC_Start(&DacHandle, DAC_CHANNEL_1);
bogdanm 0:9b334a45a8ff 116 }
bogdanm 0:9b334a45a8ff 117 if (obj->channel == 2) {
mbed_official 8:69ce7aaad4c4 118 HAL_DAC_SetValue(&DacHandle, DAC_CHANNEL_2, DAC_ALIGN_12B_R, (value & DAC_RANGE));
bogdanm 0:9b334a45a8ff 119 HAL_DAC_Start(&DacHandle, DAC_CHANNEL_2);
bogdanm 0:9b334a45a8ff 120 }
bogdanm 0:9b334a45a8ff 121 }
bogdanm 0:9b334a45a8ff 122
mbed_official 8:69ce7aaad4c4 123 static inline int dac_read(dac_t *obj) {
bogdanm 0:9b334a45a8ff 124 if (obj->channel == 1) {
bogdanm 0:9b334a45a8ff 125 return (int)HAL_DAC_GetValue(&DacHandle, DAC_CHANNEL_1);
bogdanm 0:9b334a45a8ff 126 }
bogdanm 0:9b334a45a8ff 127 if (obj->channel == 2) {
bogdanm 0:9b334a45a8ff 128 return (int)HAL_DAC_GetValue(&DacHandle, DAC_CHANNEL_2);
bogdanm 0:9b334a45a8ff 129 }
bogdanm 0:9b334a45a8ff 130 return 0;
bogdanm 0:9b334a45a8ff 131 }
bogdanm 0:9b334a45a8ff 132
mbed_official 8:69ce7aaad4c4 133 void analogout_write(dac_t *obj, float value) {
bogdanm 0:9b334a45a8ff 134 if (value < 0.0f) {
bogdanm 0:9b334a45a8ff 135 dac_write(obj, 0); // Min value
bogdanm 0:9b334a45a8ff 136 } else if (value > 1.0f) {
mbed_official 8:69ce7aaad4c4 137 dac_write(obj, (int)DAC_RANGE); // Max value
bogdanm 0:9b334a45a8ff 138 } else {
mbed_official 8:69ce7aaad4c4 139 dac_write(obj, (int)(value * (float)DAC_RANGE));
bogdanm 0:9b334a45a8ff 140 }
bogdanm 0:9b334a45a8ff 141 }
bogdanm 0:9b334a45a8ff 142
mbed_official 8:69ce7aaad4c4 143 void analogout_write_u16(dac_t *obj, uint16_t value) {
mbed_official 8:69ce7aaad4c4 144 dac_write(obj, value >> (16 - DAC_NB_BITS));
bogdanm 0:9b334a45a8ff 145 }
bogdanm 0:9b334a45a8ff 146
mbed_official 8:69ce7aaad4c4 147 float analogout_read(dac_t *obj) {
bogdanm 0:9b334a45a8ff 148 uint32_t value = dac_read(obj);
mbed_official 8:69ce7aaad4c4 149 return (float)value * (1.0f / (float)DAC_RANGE);
bogdanm 0:9b334a45a8ff 150 }
bogdanm 0:9b334a45a8ff 151
mbed_official 8:69ce7aaad4c4 152 uint16_t analogout_read_u16(dac_t *obj) {
mbed_official 8:69ce7aaad4c4 153 uint32_t value = dac_read(obj);
mbed_official 8:69ce7aaad4c4 154 return (value << 4) | ((value >> 8) & 0x000F); // Conversion from 12 to 16 bits
bogdanm 0:9b334a45a8ff 155 }
bogdanm 0:9b334a45a8ff 156
bogdanm 0:9b334a45a8ff 157 #endif // DEVICE_ANALOGOUT