Sergey Solodunov / mbed-dev

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) 2014, 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 pa4_used = 0;
bogdanm 0:9b334a45a8ff 45 static int pa5_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;
bogdanm 0:9b334a45a8ff 49
bogdanm 0:9b334a45a8ff 50 DacHandle.Instance = DAC;
bogdanm 0:9b334a45a8ff 51
bogdanm 0:9b334a45a8ff 52 // Get the peripheral name (DAC_1, ...) from the pin and assign it to the object
bogdanm 0:9b334a45a8ff 53 obj->dac = (DACName)pinmap_peripheral(pin, PinMap_DAC);
bogdanm 0:9b334a45a8ff 54 MBED_ASSERT(obj->dac != (DACName)NC);
bogdanm 0:9b334a45a8ff 55
bogdanm 0:9b334a45a8ff 56 // Configure GPIO
bogdanm 0:9b334a45a8ff 57 pinmap_pinout(pin, PinMap_DAC);
bogdanm 0:9b334a45a8ff 58
bogdanm 0:9b334a45a8ff 59 // Save the channel for future use
bogdanm 0:9b334a45a8ff 60 obj->pin = pin;
bogdanm 0:9b334a45a8ff 61
bogdanm 0:9b334a45a8ff 62 // Enable DAC clock
bogdanm 0:9b334a45a8ff 63 __DAC_CLK_ENABLE();
bogdanm 0:9b334a45a8ff 64
bogdanm 0:9b334a45a8ff 65 // Configure DAC
bogdanm 0:9b334a45a8ff 66 sConfig.DAC_Trigger = DAC_TRIGGER_NONE;
bogdanm 0:9b334a45a8ff 67 sConfig.DAC_OutputBuffer = DAC_OUTPUTBUFFER_DISABLE;
bogdanm 0:9b334a45a8ff 68
bogdanm 0:9b334a45a8ff 69 if (pin == PA_4) {
bogdanm 0:9b334a45a8ff 70 HAL_DAC_ConfigChannel(&DacHandle, &sConfig, DAC_CHANNEL_1);
bogdanm 0:9b334a45a8ff 71 pa4_used = 1;
bogdanm 0:9b334a45a8ff 72 } else { // PA_5
bogdanm 0:9b334a45a8ff 73 HAL_DAC_ConfigChannel(&DacHandle, &sConfig, DAC_CHANNEL_2);
bogdanm 0:9b334a45a8ff 74 pa5_used = 1;
bogdanm 0:9b334a45a8ff 75 }
bogdanm 0:9b334a45a8ff 76
bogdanm 0:9b334a45a8ff 77 analogout_write_u16(obj, 0);
bogdanm 0:9b334a45a8ff 78 }
bogdanm 0:9b334a45a8ff 79
mbed_official 8:69ce7aaad4c4 80 void analogout_free(dac_t *obj) {
bogdanm 0:9b334a45a8ff 81 // Reset DAC and disable clock
bogdanm 0:9b334a45a8ff 82 if (obj->pin == PA_4) pa4_used = 0;
bogdanm 0:9b334a45a8ff 83 if (obj->pin == PA_5) pa5_used = 0;
bogdanm 0:9b334a45a8ff 84 if ((pa4_used == 0) && (pa5_used == 0)) {
bogdanm 0:9b334a45a8ff 85 __DAC_FORCE_RESET();
bogdanm 0:9b334a45a8ff 86 __DAC_RELEASE_RESET();
bogdanm 0:9b334a45a8ff 87 __DAC_CLK_DISABLE();
bogdanm 0:9b334a45a8ff 88 }
bogdanm 0:9b334a45a8ff 89
bogdanm 0:9b334a45a8ff 90 // Configure GPIO
bogdanm 0:9b334a45a8ff 91 pin_function(obj->pin, STM_PIN_DATA(STM_MODE_INPUT, GPIO_NOPULL, 0));
bogdanm 0:9b334a45a8ff 92 }
bogdanm 0:9b334a45a8ff 93
mbed_official 8:69ce7aaad4c4 94 static inline void dac_write(dac_t *obj, int value) {
bogdanm 0:9b334a45a8ff 95 if (obj->pin == PA_4) {
mbed_official 8:69ce7aaad4c4 96 HAL_DAC_SetValue(&DacHandle, DAC_CHANNEL_1, DAC_ALIGN_12B_R, (value & DAC_RANGE));
bogdanm 0:9b334a45a8ff 97 HAL_DAC_Start(&DacHandle, DAC_CHANNEL_1);
bogdanm 0:9b334a45a8ff 98 } else { // PA_5
mbed_official 8:69ce7aaad4c4 99 HAL_DAC_SetValue(&DacHandle, DAC_CHANNEL_2, DAC_ALIGN_12B_R, (value & DAC_RANGE));
bogdanm 0:9b334a45a8ff 100 HAL_DAC_Start(&DacHandle, DAC_CHANNEL_2);
bogdanm 0:9b334a45a8ff 101 }
bogdanm 0:9b334a45a8ff 102 }
bogdanm 0:9b334a45a8ff 103
mbed_official 8:69ce7aaad4c4 104 static inline int dac_read(dac_t *obj) {
bogdanm 0:9b334a45a8ff 105 if (obj->pin == PA_4) {
bogdanm 0:9b334a45a8ff 106 return (int)HAL_DAC_GetValue(&DacHandle, DAC_CHANNEL_1);
bogdanm 0:9b334a45a8ff 107 } else { // PA_5
bogdanm 0:9b334a45a8ff 108 return (int)HAL_DAC_GetValue(&DacHandle, DAC_CHANNEL_2);
bogdanm 0:9b334a45a8ff 109 }
bogdanm 0:9b334a45a8ff 110 }
bogdanm 0:9b334a45a8ff 111
mbed_official 8:69ce7aaad4c4 112 void analogout_write(dac_t *obj, float value) {
bogdanm 0:9b334a45a8ff 113 if (value < 0.0f) {
bogdanm 0:9b334a45a8ff 114 dac_write(obj, 0); // Min value
bogdanm 0:9b334a45a8ff 115 } else if (value > 1.0f) {
mbed_official 8:69ce7aaad4c4 116 dac_write(obj, (int)DAC_RANGE); // Max value
bogdanm 0:9b334a45a8ff 117 } else {
mbed_official 8:69ce7aaad4c4 118 dac_write(obj, (int)(value * (float)DAC_RANGE));
bogdanm 0:9b334a45a8ff 119 }
bogdanm 0:9b334a45a8ff 120 }
bogdanm 0:9b334a45a8ff 121
mbed_official 8:69ce7aaad4c4 122 void analogout_write_u16(dac_t *obj, uint16_t value) {
mbed_official 8:69ce7aaad4c4 123 dac_write(obj, value >> (16 - DAC_NB_BITS));
bogdanm 0:9b334a45a8ff 124 }
bogdanm 0:9b334a45a8ff 125
mbed_official 8:69ce7aaad4c4 126 float analogout_read(dac_t *obj) {
bogdanm 0:9b334a45a8ff 127 uint32_t value = dac_read(obj);
mbed_official 8:69ce7aaad4c4 128 return (float)value * (1.0f / (float)DAC_RANGE);
bogdanm 0:9b334a45a8ff 129 }
bogdanm 0:9b334a45a8ff 130
mbed_official 8:69ce7aaad4c4 131 uint16_t analogout_read_u16(dac_t *obj) {
mbed_official 8:69ce7aaad4c4 132 uint32_t value = dac_read(obj);
mbed_official 8:69ce7aaad4c4 133 return (value << 4) | ((value >> 8) & 0x000F); // Conversion from 12 to 16 bits
bogdanm 0:9b334a45a8ff 134 }
bogdanm 0:9b334a45a8ff 135
bogdanm 0:9b334a45a8ff 136 #endif // DEVICE_ANALOGOUT