Gan likun / The prosthetic control

The prosthetic control（MIT）

targets/TARGET_STM/TARGET_STM32F4/analogout_device.c@0:20e0c61e0684, 2022-06-23 (annotated)

Committer:
ganlikun
Date:
Thu Jun 23 05:23:34 2022 +0000
Revision:
0:20e0c61e0684
01

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ganlikun 0:20e0c61e0684 1 /* mbed Microcontroller Library
ganlikun 0:20e0c61e0684 2 * Copyright (c) 2015, STMicroelectronics
ganlikun 0:20e0c61e0684 3 * All rights reserved.
ganlikun 0:20e0c61e0684 4 *
ganlikun 0:20e0c61e0684 5 * Redistribution and use in source and binary forms, with or without
ganlikun 0:20e0c61e0684 6 * modification, are permitted provided that the following conditions are met:
ganlikun 0:20e0c61e0684 7 *
ganlikun 0:20e0c61e0684 8 * 1. Redistributions of source code must retain the above copyright notice,
ganlikun 0:20e0c61e0684 9 * this list of conditions and the following disclaimer.
ganlikun 0:20e0c61e0684 10 * 2. Redistributions in binary form must reproduce the above copyright notice,
ganlikun 0:20e0c61e0684 11 * this list of conditions and the following disclaimer in the documentation
ganlikun 0:20e0c61e0684 12 * and/or other materials provided with the distribution.
ganlikun 0:20e0c61e0684 13 * 3. Neither the name of STMicroelectronics nor the names of its contributors
ganlikun 0:20e0c61e0684 14 * may be used to endorse or promote products derived from this software
ganlikun 0:20e0c61e0684 15 * without specific prior written permission.
ganlikun 0:20e0c61e0684 16 *
ganlikun 0:20e0c61e0684 17 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
ganlikun 0:20e0c61e0684 18 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
ganlikun 0:20e0c61e0684 19 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
ganlikun 0:20e0c61e0684 20 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
ganlikun 0:20e0c61e0684 21 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
ganlikun 0:20e0c61e0684 22 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
ganlikun 0:20e0c61e0684 23 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
ganlikun 0:20e0c61e0684 24 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
ganlikun 0:20e0c61e0684 25 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
ganlikun 0:20e0c61e0684 26 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
ganlikun 0:20e0c61e0684 27 */
ganlikun 0:20e0c61e0684 28 #include "analogout_api.h"
ganlikun 0:20e0c61e0684 29
ganlikun 0:20e0c61e0684 30 #if DEVICE_ANALOGOUT
ganlikun 0:20e0c61e0684 31
ganlikun 0:20e0c61e0684 32 #include "cmsis.h"
ganlikun 0:20e0c61e0684 33 #include "pinmap.h"
ganlikun 0:20e0c61e0684 34 #include "mbed_error.h"
ganlikun 0:20e0c61e0684 35 #include "stm32f4xx_hal.h"
ganlikun 0:20e0c61e0684 36 #include "PeripheralPins.h"
ganlikun 0:20e0c61e0684 37
ganlikun 0:20e0c61e0684 38 void analogout_init(dac_t *obj, PinName pin) {
ganlikun 0:20e0c61e0684 39 DAC_ChannelConfTypeDef sConfig;
ganlikun 0:20e0c61e0684 40
ganlikun 0:20e0c61e0684 41 // Get the peripheral name (DAC_1, ...) from the pin and assign it to the object
ganlikun 0:20e0c61e0684 42 obj->dac = (DACName)pinmap_peripheral(pin, PinMap_DAC);
ganlikun 0:20e0c61e0684 43 // Get the functions (dac channel) from the pin and assign it to the object
ganlikun 0:20e0c61e0684 44 uint32_t function = pinmap_function(pin, PinMap_DAC);
ganlikun 0:20e0c61e0684 45 MBED_ASSERT(function != (uint32_t)NC);
ganlikun 0:20e0c61e0684 46
ganlikun 0:20e0c61e0684 47 // Save the channel for the write and read functions
ganlikun 0:20e0c61e0684 48 switch (STM_PIN_CHANNEL(function)) {
ganlikun 0:20e0c61e0684 49 case 1:
ganlikun 0:20e0c61e0684 50 obj->channel = DAC_CHANNEL_1;
ganlikun 0:20e0c61e0684 51 break;
ganlikun 0:20e0c61e0684 52 #if defined(DAC_CHANNEL_2)
ganlikun 0:20e0c61e0684 53 case 2:
ganlikun 0:20e0c61e0684 54 obj->channel = DAC_CHANNEL_2;
ganlikun 0:20e0c61e0684 55 break;
ganlikun 0:20e0c61e0684 56 #endif
ganlikun 0:20e0c61e0684 57 default:
ganlikun 0:20e0c61e0684 58 error("Unknown DAC channel");
ganlikun 0:20e0c61e0684 59 break;
ganlikun 0:20e0c61e0684 60 }
ganlikun 0:20e0c61e0684 61
ganlikun 0:20e0c61e0684 62 if (obj->dac == (DACName)NC) {
ganlikun 0:20e0c61e0684 63 error("DAC pin mapping failed");
ganlikun 0:20e0c61e0684 64 }
ganlikun 0:20e0c61e0684 65
ganlikun 0:20e0c61e0684 66 // Configure GPIO
ganlikun 0:20e0c61e0684 67 pinmap_pinout(pin, PinMap_DAC);
ganlikun 0:20e0c61e0684 68
ganlikun 0:20e0c61e0684 69 __HAL_RCC_GPIOA_CLK_ENABLE();
ganlikun 0:20e0c61e0684 70
ganlikun 0:20e0c61e0684 71 __HAL_RCC_DAC_CLK_ENABLE();
ganlikun 0:20e0c61e0684 72
ganlikun 0:20e0c61e0684 73 obj->handle.Instance = DAC;
ganlikun 0:20e0c61e0684 74 if (HAL_DAC_Init(&obj->handle) != HAL_OK ) {
ganlikun 0:20e0c61e0684 75 error("HAL_DAC_Init failed");
ganlikun 0:20e0c61e0684 76 }
ganlikun 0:20e0c61e0684 77
ganlikun 0:20e0c61e0684 78 sConfig.DAC_Trigger = DAC_TRIGGER_NONE;
ganlikun 0:20e0c61e0684 79 sConfig.DAC_OutputBuffer = DAC_OUTPUTBUFFER_ENABLE;
ganlikun 0:20e0c61e0684 80
ganlikun 0:20e0c61e0684 81 if (HAL_DAC_ConfigChannel(&obj->handle, &sConfig, obj->channel) != HAL_OK) {
ganlikun 0:20e0c61e0684 82 error("HAL_DAC_ConfigChannel failed");
ganlikun 0:20e0c61e0684 83 }
ganlikun 0:20e0c61e0684 84
ganlikun 0:20e0c61e0684 85 analogout_write_u16(obj, 0);
ganlikun 0:20e0c61e0684 86 }
ganlikun 0:20e0c61e0684 87
ganlikun 0:20e0c61e0684 88 void analogout_free(dac_t *obj) {
ganlikun 0:20e0c61e0684 89 }
ganlikun 0:20e0c61e0684 90
ganlikun 0:20e0c61e0684 91 #endif // DEVICE_ANALOGOUT
ganlikun 0:20e0c61e0684 92