mbed-os

Dependents:   cobaLCDJoyMotor_Thread odometry_omni_3roda_v3 odometry_omni_3roda_v1 odometry_omni_3roda_v2 ... more

Committer:
be_bryan
Date:
Mon Dec 11 17:54:04 2017 +0000
Revision:
0:b74591d5ab33
motor ++

Who changed what in which revision?

UserRevisionLine numberNew contents of line
be_bryan 0:b74591d5ab33 1 /* mbed Microcontroller Library
be_bryan 0:b74591d5ab33 2 * Copyright (c) 2015, STMicroelectronics
be_bryan 0:b74591d5ab33 3 * All rights reserved.
be_bryan 0:b74591d5ab33 4 *
be_bryan 0:b74591d5ab33 5 * Redistribution and use in source and binary forms, with or without
be_bryan 0:b74591d5ab33 6 * modification, are permitted provided that the following conditions are met:
be_bryan 0:b74591d5ab33 7 *
be_bryan 0:b74591d5ab33 8 * 1. Redistributions of source code must retain the above copyright notice,
be_bryan 0:b74591d5ab33 9 * this list of conditions and the following disclaimer.
be_bryan 0:b74591d5ab33 10 * 2. Redistributions in binary form must reproduce the above copyright notice,
be_bryan 0:b74591d5ab33 11 * this list of conditions and the following disclaimer in the documentation
be_bryan 0:b74591d5ab33 12 * and/or other materials provided with the distribution.
be_bryan 0:b74591d5ab33 13 * 3. Neither the name of STMicroelectronics nor the names of its contributors
be_bryan 0:b74591d5ab33 14 * may be used to endorse or promote products derived from this software
be_bryan 0:b74591d5ab33 15 * without specific prior written permission.
be_bryan 0:b74591d5ab33 16 *
be_bryan 0:b74591d5ab33 17 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
be_bryan 0:b74591d5ab33 18 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
be_bryan 0:b74591d5ab33 19 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
be_bryan 0:b74591d5ab33 20 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
be_bryan 0:b74591d5ab33 21 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
be_bryan 0:b74591d5ab33 22 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
be_bryan 0:b74591d5ab33 23 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
be_bryan 0:b74591d5ab33 24 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
be_bryan 0:b74591d5ab33 25 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
be_bryan 0:b74591d5ab33 26 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
be_bryan 0:b74591d5ab33 27 */
be_bryan 0:b74591d5ab33 28 #include "mbed_assert.h"
be_bryan 0:b74591d5ab33 29 #include "analogout_api.h"
be_bryan 0:b74591d5ab33 30
be_bryan 0:b74591d5ab33 31 #if DEVICE_ANALOGOUT
be_bryan 0:b74591d5ab33 32
be_bryan 0:b74591d5ab33 33 #include "cmsis.h"
be_bryan 0:b74591d5ab33 34 #include "pinmap.h"
be_bryan 0:b74591d5ab33 35 #include "mbed_error.h"
be_bryan 0:b74591d5ab33 36 #include "PeripheralPins.h"
be_bryan 0:b74591d5ab33 37
be_bryan 0:b74591d5ab33 38 // These variables are used for the "free" function
be_bryan 0:b74591d5ab33 39 static int pa4_used = 0;
be_bryan 0:b74591d5ab33 40 static int pa5_used = 0;
be_bryan 0:b74591d5ab33 41
be_bryan 0:b74591d5ab33 42 void analogout_init(dac_t *obj, PinName pin) {
be_bryan 0:b74591d5ab33 43 DAC_ChannelConfTypeDef sConfig = {0};
be_bryan 0:b74591d5ab33 44
be_bryan 0:b74591d5ab33 45 // Get the peripheral name from the pin and assign it to the object
be_bryan 0:b74591d5ab33 46 obj->dac = (DACName)pinmap_peripheral(pin, PinMap_DAC);
be_bryan 0:b74591d5ab33 47 MBED_ASSERT(obj->dac != (DACName)NC);
be_bryan 0:b74591d5ab33 48
be_bryan 0:b74591d5ab33 49 // Get the pin function and assign the used channel to the object
be_bryan 0:b74591d5ab33 50 uint32_t function = pinmap_function(pin, PinMap_DAC);
be_bryan 0:b74591d5ab33 51 MBED_ASSERT(function != (uint32_t)NC);
be_bryan 0:b74591d5ab33 52
be_bryan 0:b74591d5ab33 53 // Save the channel for the write and read functions
be_bryan 0:b74591d5ab33 54 switch (STM_PIN_CHANNEL(function)) {
be_bryan 0:b74591d5ab33 55 case 1:
be_bryan 0:b74591d5ab33 56 obj->channel = DAC_CHANNEL_1;
be_bryan 0:b74591d5ab33 57 break;
be_bryan 0:b74591d5ab33 58 #if defined(DAC_CHANNEL_2)
be_bryan 0:b74591d5ab33 59 case 2:
be_bryan 0:b74591d5ab33 60 obj->channel = DAC_CHANNEL_2;
be_bryan 0:b74591d5ab33 61 break;
be_bryan 0:b74591d5ab33 62 #endif
be_bryan 0:b74591d5ab33 63 default:
be_bryan 0:b74591d5ab33 64 error("Unknown DAC channel");
be_bryan 0:b74591d5ab33 65 break;
be_bryan 0:b74591d5ab33 66 }
be_bryan 0:b74591d5ab33 67
be_bryan 0:b74591d5ab33 68 // Configure GPIO
be_bryan 0:b74591d5ab33 69 pinmap_pinout(pin, PinMap_DAC);
be_bryan 0:b74591d5ab33 70
be_bryan 0:b74591d5ab33 71 // Save the pin for future use
be_bryan 0:b74591d5ab33 72 obj->pin = pin;
be_bryan 0:b74591d5ab33 73
be_bryan 0:b74591d5ab33 74 // Enable DAC clock
be_bryan 0:b74591d5ab33 75 if (obj->dac == DAC_1) {
be_bryan 0:b74591d5ab33 76 __DAC1_CLK_ENABLE();
be_bryan 0:b74591d5ab33 77 }
be_bryan 0:b74591d5ab33 78 #if defined(DAC2)
be_bryan 0:b74591d5ab33 79 if (obj->dac == DAC_2) {
be_bryan 0:b74591d5ab33 80 __DAC2_CLK_ENABLE();
be_bryan 0:b74591d5ab33 81 }
be_bryan 0:b74591d5ab33 82 #endif
be_bryan 0:b74591d5ab33 83
be_bryan 0:b74591d5ab33 84 // Configure DAC
be_bryan 0:b74591d5ab33 85 obj->handle.Instance = (DAC_TypeDef *)(obj->dac);
be_bryan 0:b74591d5ab33 86 obj->handle.State = HAL_DAC_STATE_RESET;
be_bryan 0:b74591d5ab33 87
be_bryan 0:b74591d5ab33 88 if (HAL_DAC_Init(&obj->handle) != HAL_OK ) {
be_bryan 0:b74591d5ab33 89 error("HAL_DAC_Init failed");
be_bryan 0:b74591d5ab33 90 }
be_bryan 0:b74591d5ab33 91
be_bryan 0:b74591d5ab33 92 /* Enable both Buffer and Switch in the configuration,
be_bryan 0:b74591d5ab33 93 * letting HAL layer in charge of selecting either one
be_bryan 0:b74591d5ab33 94 * or the other depending on the actual DAC instance and
be_bryan 0:b74591d5ab33 95 * channel being configured.
be_bryan 0:b74591d5ab33 96 */
be_bryan 0:b74591d5ab33 97 sConfig.DAC_Trigger = DAC_TRIGGER_NONE;
be_bryan 0:b74591d5ab33 98 sConfig.DAC_OutputBuffer = DAC_OUTPUTBUFFER_ENABLE;
be_bryan 0:b74591d5ab33 99 #if defined(DAC_OUTPUTSWITCH_ENABLE)
be_bryan 0:b74591d5ab33 100 sConfig.DAC_OutputSwitch = DAC_OUTPUTSWITCH_ENABLE;
be_bryan 0:b74591d5ab33 101 #endif
be_bryan 0:b74591d5ab33 102
be_bryan 0:b74591d5ab33 103 if (pin == PA_4) {
be_bryan 0:b74591d5ab33 104 pa4_used = 1;
be_bryan 0:b74591d5ab33 105 }
be_bryan 0:b74591d5ab33 106
be_bryan 0:b74591d5ab33 107 if (pin == PA_5) {
be_bryan 0:b74591d5ab33 108 pa5_used = 1;
be_bryan 0:b74591d5ab33 109 }
be_bryan 0:b74591d5ab33 110
be_bryan 0:b74591d5ab33 111 if (HAL_DAC_ConfigChannel(&obj->handle, &sConfig, obj->channel) != HAL_OK) {
be_bryan 0:b74591d5ab33 112 error("HAL_DAC_ConfigChannel failed");
be_bryan 0:b74591d5ab33 113 }
be_bryan 0:b74591d5ab33 114
be_bryan 0:b74591d5ab33 115 analogout_write_u16(obj, 0);
be_bryan 0:b74591d5ab33 116 }
be_bryan 0:b74591d5ab33 117
be_bryan 0:b74591d5ab33 118 void analogout_free(dac_t *obj) {
be_bryan 0:b74591d5ab33 119 // Reset DAC and disable clock
be_bryan 0:b74591d5ab33 120 if (obj->pin == PA_4) pa4_used = 0;
be_bryan 0:b74591d5ab33 121 if (obj->pin == PA_5) pa5_used = 0;
be_bryan 0:b74591d5ab33 122
be_bryan 0:b74591d5ab33 123 if ((pa4_used == 0) && (pa5_used == 0)) {
be_bryan 0:b74591d5ab33 124 __DAC1_FORCE_RESET();
be_bryan 0:b74591d5ab33 125 __DAC1_RELEASE_RESET();
be_bryan 0:b74591d5ab33 126 __DAC1_CLK_DISABLE();
be_bryan 0:b74591d5ab33 127 }
be_bryan 0:b74591d5ab33 128
be_bryan 0:b74591d5ab33 129 #if defined(DAC2)
be_bryan 0:b74591d5ab33 130 if (obj->pin == PA_6) {
be_bryan 0:b74591d5ab33 131 __DAC2_FORCE_RESET();
be_bryan 0:b74591d5ab33 132 __DAC2_RELEASE_RESET();
be_bryan 0:b74591d5ab33 133 __DAC2_CLK_DISABLE();
be_bryan 0:b74591d5ab33 134 }
be_bryan 0:b74591d5ab33 135 #endif
be_bryan 0:b74591d5ab33 136
be_bryan 0:b74591d5ab33 137 // Configure GPIO
be_bryan 0:b74591d5ab33 138 pin_function(obj->pin, STM_PIN_DATA(STM_MODE_INPUT, GPIO_NOPULL, 0));
be_bryan 0:b74591d5ab33 139 }
be_bryan 0:b74591d5ab33 140
be_bryan 0:b74591d5ab33 141 #endif // DEVICE_ANALOGOUT