mbed library sources. Supersedes mbed-src.
Fork of mbed by
targets/hal/TARGET_STM/TARGET_STM32L0/analogout_api.c@8:69ce7aaad4c4, 2015-10-26 (annotated)
- 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?
User | Revision | Line number | New 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; |
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 | __DAC_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 | sConfig.DAC_Trigger = DAC_TRIGGER_NONE; |
bogdanm | 0:9b334a45a8ff | 72 | sConfig.DAC_OutputBuffer = DAC_OUTPUTBUFFER_DISABLE; |
bogdanm | 0:9b334a45a8ff | 73 | |
bogdanm | 0:9b334a45a8ff | 74 | #if defined(DAC_CHANNEL_2) |
bogdanm | 0:9b334a45a8ff | 75 | if (obj->channel == 2) { |
bogdanm | 0:9b334a45a8ff | 76 | if (HAL_DAC_ConfigChannel(&DacHandle, &sConfig, DAC_CHANNEL_2) != HAL_OK) { |
bogdanm | 0:9b334a45a8ff | 77 | error("Cannot configure DAC channel 2"); |
bogdanm | 0:9b334a45a8ff | 78 | } |
bogdanm | 0:9b334a45a8ff | 79 | channel2_used = 1; |
bogdanm | 0:9b334a45a8ff | 80 | } else |
bogdanm | 0:9b334a45a8ff | 81 | #endif |
bogdanm | 0:9b334a45a8ff | 82 | { |
bogdanm | 0:9b334a45a8ff | 83 | // channel 1 per default |
bogdanm | 0:9b334a45a8ff | 84 | if (HAL_DAC_ConfigChannel(&DacHandle, &sConfig, DAC_CHANNEL_1) != HAL_OK) { |
bogdanm | 0:9b334a45a8ff | 85 | error("Cannot configure DAC channel 1"); |
bogdanm | 0:9b334a45a8ff | 86 | } |
bogdanm | 0:9b334a45a8ff | 87 | obj->channel = 1; |
bogdanm | 0:9b334a45a8ff | 88 | channel1_used = 1; |
bogdanm | 0:9b334a45a8ff | 89 | } |
bogdanm | 0:9b334a45a8ff | 90 | |
bogdanm | 0:9b334a45a8ff | 91 | analogout_write_u16(obj, 0); |
bogdanm | 0:9b334a45a8ff | 92 | } |
bogdanm | 0:9b334a45a8ff | 93 | |
mbed_official | 8:69ce7aaad4c4 | 94 | void analogout_free(dac_t *obj) { |
bogdanm | 0:9b334a45a8ff | 95 | // Reset DAC and disable clock |
bogdanm | 0:9b334a45a8ff | 96 | if (obj->channel == 1) channel1_used = 0; |
bogdanm | 0:9b334a45a8ff | 97 | if (obj->channel == 2) channel2_used = 0; |
bogdanm | 0:9b334a45a8ff | 98 | |
bogdanm | 0:9b334a45a8ff | 99 | if ((channel1_used == 0) && (channel2_used == 0)) { |
bogdanm | 0:9b334a45a8ff | 100 | __DAC_FORCE_RESET(); |
bogdanm | 0:9b334a45a8ff | 101 | __DAC_RELEASE_RESET(); |
bogdanm | 0:9b334a45a8ff | 102 | __DAC_CLK_DISABLE(); |
bogdanm | 0:9b334a45a8ff | 103 | } |
bogdanm | 0:9b334a45a8ff | 104 | |
bogdanm | 0:9b334a45a8ff | 105 | // Configure GPIO |
bogdanm | 0:9b334a45a8ff | 106 | pin_function(obj->pin, STM_PIN_DATA(STM_MODE_INPUT, GPIO_NOPULL, 0)); |
bogdanm | 0:9b334a45a8ff | 107 | } |
bogdanm | 0:9b334a45a8ff | 108 | |
mbed_official | 8:69ce7aaad4c4 | 109 | static inline void dac_write(dac_t *obj, int value) { |
bogdanm | 0:9b334a45a8ff | 110 | if (obj->channel == 1) { |
mbed_official | 8:69ce7aaad4c4 | 111 | HAL_DAC_SetValue(&DacHandle, DAC_CHANNEL_1, DAC_ALIGN_12B_R, (value & DAC_RANGE)); |
bogdanm | 0:9b334a45a8ff | 112 | HAL_DAC_Start(&DacHandle, DAC_CHANNEL_1); |
bogdanm | 0:9b334a45a8ff | 113 | } |
bogdanm | 0:9b334a45a8ff | 114 | #if defined(DAC_CHANNEL_2) |
bogdanm | 0:9b334a45a8ff | 115 | if (obj->channel == 2) { |
mbed_official | 8:69ce7aaad4c4 | 116 | HAL_DAC_SetValue(&DacHandle, DAC_CHANNEL_2, DAC_ALIGN_12B_R, (value & DAC_RANGE)); |
bogdanm | 0:9b334a45a8ff | 117 | HAL_DAC_Start(&DacHandle, DAC_CHANNEL_2); |
bogdanm | 0:9b334a45a8ff | 118 | } |
bogdanm | 0:9b334a45a8ff | 119 | #endif |
bogdanm | 0:9b334a45a8ff | 120 | } |
bogdanm | 0:9b334a45a8ff | 121 | |
mbed_official | 8:69ce7aaad4c4 | 122 | static inline int dac_read(dac_t *obj) { |
bogdanm | 0:9b334a45a8ff | 123 | if (obj->channel == 1) { |
bogdanm | 0:9b334a45a8ff | 124 | return (int)HAL_DAC_GetValue(&DacHandle, DAC_CHANNEL_1); |
bogdanm | 0:9b334a45a8ff | 125 | } |
bogdanm | 0:9b334a45a8ff | 126 | #if defined(DAC_CHANNEL_2) |
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 | #endif |
bogdanm | 0:9b334a45a8ff | 131 | return 0; |
bogdanm | 0:9b334a45a8ff | 132 | } |
bogdanm | 0:9b334a45a8ff | 133 | |
mbed_official | 8:69ce7aaad4c4 | 134 | void analogout_write(dac_t *obj, float value) { |
bogdanm | 0:9b334a45a8ff | 135 | if (value < 0.0f) { |
bogdanm | 0:9b334a45a8ff | 136 | dac_write(obj, 0); // Min value |
bogdanm | 0:9b334a45a8ff | 137 | } else if (value > 1.0f) { |
mbed_official | 8:69ce7aaad4c4 | 138 | dac_write(obj, (int)DAC_RANGE); // Max value |
bogdanm | 0:9b334a45a8ff | 139 | } else { |
mbed_official | 8:69ce7aaad4c4 | 140 | dac_write(obj, (int)(value * (float)DAC_RANGE)); |
bogdanm | 0:9b334a45a8ff | 141 | } |
bogdanm | 0:9b334a45a8ff | 142 | } |
bogdanm | 0:9b334a45a8ff | 143 | |
mbed_official | 8:69ce7aaad4c4 | 144 | void analogout_write_u16(dac_t *obj, uint16_t value) { |
mbed_official | 8:69ce7aaad4c4 | 145 | dac_write(obj, value >> (16 - DAC_NB_BITS)); |
bogdanm | 0:9b334a45a8ff | 146 | } |
bogdanm | 0:9b334a45a8ff | 147 | |
mbed_official | 8:69ce7aaad4c4 | 148 | float analogout_read(dac_t *obj) { |
bogdanm | 0:9b334a45a8ff | 149 | uint32_t value = dac_read(obj); |
mbed_official | 8:69ce7aaad4c4 | 150 | return (float)value * (1.0f / (float)DAC_RANGE); |
bogdanm | 0:9b334a45a8ff | 151 | } |
bogdanm | 0:9b334a45a8ff | 152 | |
mbed_official | 8:69ce7aaad4c4 | 153 | uint16_t analogout_read_u16(dac_t *obj) { |
mbed_official | 8:69ce7aaad4c4 | 154 | uint32_t value = dac_read(obj); |
mbed_official | 8:69ce7aaad4c4 | 155 | return (value << 4) | ((value >> 8) & 0x000F); // Conversion from 12 to 16 bits |
bogdanm | 0:9b334a45a8ff | 156 | } |
bogdanm | 0:9b334a45a8ff | 157 | |
bogdanm | 0:9b334a45a8ff | 158 | #endif // DEVICE_ANALOGOUT |