Kevin Kadooka / 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
Child:
144:ef7eb2e8f9f7
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 "analogout_api.h"
bogdanm 0:9b334a45a8ff 29
bogdanm 0:9b334a45a8ff 30 #if DEVICE_ANALOGOUT
bogdanm 0:9b334a45a8ff 31
bogdanm 0:9b334a45a8ff 32 #include "cmsis.h"
bogdanm 0:9b334a45a8ff 33 #include "pinmap.h"
bogdanm 0:9b334a45a8ff 34 #include "mbed_error.h"
bogdanm 0:9b334a45a8ff 35 #include "stm32f7xx_hal.h"
bogdanm 0:9b334a45a8ff 36 #include "PeripheralPins.h"
bogdanm 0:9b334a45a8ff 37
mbed_official 8:69ce7aaad4c4 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 DAC_HandleTypeDef DacHandle;
bogdanm 0:9b334a45a8ff 42 static DAC_ChannelConfTypeDef sConfig;
bogdanm 0:9b334a45a8ff 43
mbed_official 8:69ce7aaad4c4 44 void analogout_init(dac_t *obj, PinName pin) {
bogdanm 0:9b334a45a8ff 45 uint32_t channel ;
bogdanm 0:9b334a45a8ff 46 HAL_StatusTypeDef status;
bogdanm 0:9b334a45a8ff 47
bogdanm 0:9b334a45a8ff 48 // Get the peripheral name (DAC_1, ...) from the pin and assign it to the object
bogdanm 0:9b334a45a8ff 49 obj->dac = (DACName)pinmap_peripheral(pin, PinMap_DAC);
bogdanm 0:9b334a45a8ff 50 // Get the functions (dac channel) from the pin and assign it to the object
bogdanm 0:9b334a45a8ff 51 uint32_t function = pinmap_function(pin, PinMap_DAC);
bogdanm 0:9b334a45a8ff 52 MBED_ASSERT(function != (uint32_t)NC);
bogdanm 0:9b334a45a8ff 53 // Save the channel for the write and read functions
bogdanm 0:9b334a45a8ff 54 obj->channel = STM_PIN_CHANNEL(function);
bogdanm 0:9b334a45a8ff 55
bogdanm 0:9b334a45a8ff 56 if (obj->dac == (DACName)NC) {
bogdanm 0:9b334a45a8ff 57 error("DAC pin mapping failed");
bogdanm 0:9b334a45a8ff 58 }
bogdanm 0:9b334a45a8ff 59
bogdanm 0:9b334a45a8ff 60 // Configure GPIO
bogdanm 0:9b334a45a8ff 61 pinmap_pinout(pin, PinMap_DAC);
bogdanm 0:9b334a45a8ff 62
bogdanm 0:9b334a45a8ff 63 __GPIOA_CLK_ENABLE();
bogdanm 0:9b334a45a8ff 64
bogdanm 0:9b334a45a8ff 65 __DAC_CLK_ENABLE();
bogdanm 0:9b334a45a8ff 66
bogdanm 0:9b334a45a8ff 67 DacHandle.Instance = DAC;
bogdanm 0:9b334a45a8ff 68
bogdanm 0:9b334a45a8ff 69 status = HAL_DAC_Init(&DacHandle);
bogdanm 0:9b334a45a8ff 70 if (status != HAL_OK) {
bogdanm 0:9b334a45a8ff 71 error("HAL_DAC_Init failed");
bogdanm 0:9b334a45a8ff 72 }
bogdanm 0:9b334a45a8ff 73
bogdanm 0:9b334a45a8ff 74 sConfig.DAC_Trigger = DAC_TRIGGER_NONE;
bogdanm 0:9b334a45a8ff 75 sConfig.DAC_OutputBuffer = DAC_OUTPUTBUFFER_ENABLE;
bogdanm 0:9b334a45a8ff 76
bogdanm 0:9b334a45a8ff 77 if (obj->channel == 1) {
bogdanm 0:9b334a45a8ff 78 channel = DAC_CHANNEL_1;
bogdanm 0:9b334a45a8ff 79 } else {
bogdanm 0:9b334a45a8ff 80 channel = DAC_CHANNEL_2;
bogdanm 0:9b334a45a8ff 81 }
bogdanm 0:9b334a45a8ff 82
bogdanm 0:9b334a45a8ff 83 if (HAL_DAC_ConfigChannel(&DacHandle, &sConfig, channel) != HAL_OK) {
bogdanm 0:9b334a45a8ff 84 error("HAL_DAC_ConfigChannel failed");
bogdanm 0:9b334a45a8ff 85 }
bogdanm 0:9b334a45a8ff 86
bogdanm 0:9b334a45a8ff 87 if (HAL_DAC_Start(&DacHandle, channel) != HAL_OK) {
bogdanm 0:9b334a45a8ff 88 error("HAL_DAC_Start failed");
bogdanm 0:9b334a45a8ff 89 }
bogdanm 0:9b334a45a8ff 90
bogdanm 0:9b334a45a8ff 91 if (HAL_DAC_SetValue(&DacHandle, channel, DAC_ALIGN_12B_R, 0x000) != HAL_OK) {
bogdanm 0:9b334a45a8ff 92 error("HAL_DAC_SetValue failed");
bogdanm 0:9b334a45a8ff 93 }
bogdanm 0:9b334a45a8ff 94
bogdanm 0:9b334a45a8ff 95 }
bogdanm 0:9b334a45a8ff 96
mbed_official 8:69ce7aaad4c4 97 void analogout_free(dac_t *obj) {
bogdanm 0:9b334a45a8ff 98 }
bogdanm 0:9b334a45a8ff 99
mbed_official 8:69ce7aaad4c4 100 static inline void dac_write(dac_t *obj, int value) {
bogdanm 0:9b334a45a8ff 101 HAL_StatusTypeDef status = HAL_ERROR;
bogdanm 0:9b334a45a8ff 102
bogdanm 0:9b334a45a8ff 103 if (obj->channel == 1) {
mbed_official 8:69ce7aaad4c4 104 status = HAL_DAC_SetValue(&DacHandle, DAC_CHANNEL_1, DAC_ALIGN_12B_R, (value & DAC_RANGE));
bogdanm 0:9b334a45a8ff 105 } else if (obj->channel == 2) {
mbed_official 8:69ce7aaad4c4 106 status = HAL_DAC_SetValue(&DacHandle, DAC_CHANNEL_2, DAC_ALIGN_12B_R, (value & DAC_RANGE));
bogdanm 0:9b334a45a8ff 107 }
bogdanm 0:9b334a45a8ff 108
bogdanm 0:9b334a45a8ff 109 if (status != HAL_OK) {
bogdanm 0:9b334a45a8ff 110 error("DAC pin mapping failed");
bogdanm 0:9b334a45a8ff 111 }
bogdanm 0:9b334a45a8ff 112 }
bogdanm 0:9b334a45a8ff 113
mbed_official 8:69ce7aaad4c4 114 static inline int dac_read(dac_t *obj) {
bogdanm 0:9b334a45a8ff 115 if (obj->channel == 1) {
bogdanm 0:9b334a45a8ff 116 return (int)HAL_DAC_GetValue(&DacHandle, DAC_CHANNEL_1);
bogdanm 0:9b334a45a8ff 117 } else if (obj->channel == 2) {
bogdanm 0:9b334a45a8ff 118 return (int)HAL_DAC_GetValue(&DacHandle, DAC_CHANNEL_2);
bogdanm 0:9b334a45a8ff 119 }
bogdanm 0:9b334a45a8ff 120 return 0; /* Just silented warning */
bogdanm 0:9b334a45a8ff 121 }
bogdanm 0:9b334a45a8ff 122
mbed_official 8:69ce7aaad4c4 123 void analogout_write(dac_t *obj, float value) {
bogdanm 0:9b334a45a8ff 124 if (value < 0.0f) {
bogdanm 0:9b334a45a8ff 125 dac_write(obj, 0); // Min value
bogdanm 0:9b334a45a8ff 126 } else if (value > 1.0f) {
mbed_official 8:69ce7aaad4c4 127 dac_write(obj, (int)DAC_RANGE); // Max value
bogdanm 0:9b334a45a8ff 128 } else {
mbed_official 8:69ce7aaad4c4 129 dac_write(obj, (int)(value * (float)DAC_RANGE));
bogdanm 0:9b334a45a8ff 130 }
bogdanm 0:9b334a45a8ff 131 }
bogdanm 0:9b334a45a8ff 132
mbed_official 8:69ce7aaad4c4 133 void analogout_write_u16(dac_t *obj, uint16_t value) {
mbed_official 8:69ce7aaad4c4 134 dac_write(obj, value >> (16 - DAC_NB_BITS));
bogdanm 0:9b334a45a8ff 135 }
bogdanm 0:9b334a45a8ff 136
mbed_official 8:69ce7aaad4c4 137 float analogout_read(dac_t *obj) {
bogdanm 0:9b334a45a8ff 138 uint32_t value = dac_read(obj);
mbed_official 8:69ce7aaad4c4 139 return (float)value * (1.0f / (float)DAC_RANGE);
bogdanm 0:9b334a45a8ff 140 }
bogdanm 0:9b334a45a8ff 141
mbed_official 8:69ce7aaad4c4 142 uint16_t analogout_read_u16(dac_t *obj) {
mbed_official 8:69ce7aaad4c4 143 uint32_t value = dac_read(obj);
mbed_official 8:69ce7aaad4c4 144 return (value << 4) | ((value >> 8) & 0x000F); // Conversion from 12 to 16 bits
bogdanm 0:9b334a45a8ff 145 }
bogdanm 0:9b334a45a8ff 146
bogdanm 0:9b334a45a8ff 147 #endif // DEVICE_ANALOGOUT