EL4121 Embedded System / mbed-os

mbed-os

Dependents:   cobaLCDJoyMotor_Thread odometry_omni_3roda_v3 odometry_omni_3roda_v1 odometry_omni_3roda_v2 ... more

targets/TARGET_STM/port_api.c@0:b74591d5ab33, 2017-12-11 (annotated)

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 *******************************************************************************
be_bryan 0:b74591d5ab33 3 * Copyright (c) 2016, STMicroelectronics
be_bryan 0:b74591d5ab33 4 * All rights reserved.
be_bryan 0:b74591d5ab33 5 *
be_bryan 0:b74591d5ab33 6 * Redistribution and use in source and binary forms, with or without
be_bryan 0:b74591d5ab33 7 * modification, are permitted provided that the following conditions are met:
be_bryan 0:b74591d5ab33 8 *
be_bryan 0:b74591d5ab33 9 * 1. Redistributions of source code must retain the above copyright notice,
be_bryan 0:b74591d5ab33 10 * this list of conditions and the following disclaimer.
be_bryan 0:b74591d5ab33 11 * 2. Redistributions in binary form must reproduce the above copyright notice,
be_bryan 0:b74591d5ab33 12 * this list of conditions and the following disclaimer in the documentation
be_bryan 0:b74591d5ab33 13 * and/or other materials provided with the distribution.
be_bryan 0:b74591d5ab33 14 * 3. Neither the name of STMicroelectronics nor the names of its contributors
be_bryan 0:b74591d5ab33 15 * may be used to endorse or promote products derived from this software
be_bryan 0:b74591d5ab33 16 * without specific prior written permission.
be_bryan 0:b74591d5ab33 17 *
be_bryan 0:b74591d5ab33 18 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
be_bryan 0:b74591d5ab33 19 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
be_bryan 0:b74591d5ab33 20 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
be_bryan 0:b74591d5ab33 21 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
be_bryan 0:b74591d5ab33 22 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
be_bryan 0:b74591d5ab33 23 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
be_bryan 0:b74591d5ab33 24 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
be_bryan 0:b74591d5ab33 25 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
be_bryan 0:b74591d5ab33 26 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
be_bryan 0:b74591d5ab33 27 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
be_bryan 0:b74591d5ab33 28 *******************************************************************************
be_bryan 0:b74591d5ab33 29 */
be_bryan 0:b74591d5ab33 30 #include "port_api.h"
be_bryan 0:b74591d5ab33 31 #include "pinmap.h"
be_bryan 0:b74591d5ab33 32 #include "gpio_api.h"
be_bryan 0:b74591d5ab33 33 #include "mbed_error.h"
be_bryan 0:b74591d5ab33 34
be_bryan 0:b74591d5ab33 35 #if DEVICE_PORTIN || DEVICE_PORTOUT
be_bryan 0:b74591d5ab33 36
be_bryan 0:b74591d5ab33 37 extern GPIO_TypeDef *Set_GPIO_Clock(uint32_t port_idx);
be_bryan 0:b74591d5ab33 38
be_bryan 0:b74591d5ab33 39 // high nibble = port number (0=A, 1=B, 2=C, 3=D, 4=E, 5=F, ...)
be_bryan 0:b74591d5ab33 40 // low nibble = pin number
be_bryan 0:b74591d5ab33 41 PinName port_pin(PortName port, int pin_n)
be_bryan 0:b74591d5ab33 42 {
be_bryan 0:b74591d5ab33 43 return (PinName)(pin_n + (port << 4));
be_bryan 0:b74591d5ab33 44 }
be_bryan 0:b74591d5ab33 45
be_bryan 0:b74591d5ab33 46 void port_init(port_t *obj, PortName port, int mask, PinDirection dir)
be_bryan 0:b74591d5ab33 47 {
be_bryan 0:b74591d5ab33 48 uint32_t port_index = (uint32_t)port;
be_bryan 0:b74591d5ab33 49
be_bryan 0:b74591d5ab33 50 // Enable GPIO clock
be_bryan 0:b74591d5ab33 51 GPIO_TypeDef *gpio = Set_GPIO_Clock(port_index);
be_bryan 0:b74591d5ab33 52
be_bryan 0:b74591d5ab33 53 // Fill PORT object structure for future use
be_bryan 0:b74591d5ab33 54 obj->port = port;
be_bryan 0:b74591d5ab33 55 obj->mask = mask;
be_bryan 0:b74591d5ab33 56 obj->direction = dir;
be_bryan 0:b74591d5ab33 57 obj->reg_in = &gpio->IDR;
be_bryan 0:b74591d5ab33 58 obj->reg_out = &gpio->ODR;
be_bryan 0:b74591d5ab33 59
be_bryan 0:b74591d5ab33 60 port_dir(obj, dir);
be_bryan 0:b74591d5ab33 61 }
be_bryan 0:b74591d5ab33 62
be_bryan 0:b74591d5ab33 63 void port_dir(port_t *obj, PinDirection dir)
be_bryan 0:b74591d5ab33 64 {
be_bryan 0:b74591d5ab33 65 uint32_t i;
be_bryan 0:b74591d5ab33 66 obj->direction = dir;
be_bryan 0:b74591d5ab33 67 for (i = 0; i < 16; i++) { // Process all pins
be_bryan 0:b74591d5ab33 68 if (obj->mask & (1 << i)) { // If the pin is used
be_bryan 0:b74591d5ab33 69 if (dir == PIN_OUTPUT) {
be_bryan 0:b74591d5ab33 70 pin_function(port_pin(obj->port, i), STM_PIN_DATA(STM_MODE_OUTPUT_PP, GPIO_NOPULL, 0));
be_bryan 0:b74591d5ab33 71 } else { // PIN_INPUT
be_bryan 0:b74591d5ab33 72 pin_function(port_pin(obj->port, i), STM_PIN_DATA(STM_MODE_INPUT, GPIO_NOPULL, 0));
be_bryan 0:b74591d5ab33 73 }
be_bryan 0:b74591d5ab33 74 }
be_bryan 0:b74591d5ab33 75 }
be_bryan 0:b74591d5ab33 76 }
be_bryan 0:b74591d5ab33 77
be_bryan 0:b74591d5ab33 78 void port_mode(port_t *obj, PinMode mode)
be_bryan 0:b74591d5ab33 79 {
be_bryan 0:b74591d5ab33 80 uint32_t i;
be_bryan 0:b74591d5ab33 81 for (i = 0; i < 16; i++) { // Process all pins
be_bryan 0:b74591d5ab33 82 if (obj->mask & (1 << i)) { // If the pin is used
be_bryan 0:b74591d5ab33 83 pin_mode(port_pin(obj->port, i), mode);
be_bryan 0:b74591d5ab33 84 }
be_bryan 0:b74591d5ab33 85 }
be_bryan 0:b74591d5ab33 86 }
be_bryan 0:b74591d5ab33 87
be_bryan 0:b74591d5ab33 88 void port_write(port_t *obj, int value)
be_bryan 0:b74591d5ab33 89 {
be_bryan 0:b74591d5ab33 90 *obj->reg_out = (*obj->reg_out & ~obj->mask) | (value & obj->mask);
be_bryan 0:b74591d5ab33 91 }
be_bryan 0:b74591d5ab33 92
be_bryan 0:b74591d5ab33 93 int port_read(port_t *obj)
be_bryan 0:b74591d5ab33 94 {
be_bryan 0:b74591d5ab33 95 if (obj->direction == PIN_OUTPUT) {
be_bryan 0:b74591d5ab33 96 return (*obj->reg_out & obj->mask);
be_bryan 0:b74591d5ab33 97 } else { // PIN_INPUT
be_bryan 0:b74591d5ab33 98 return (*obj->reg_in & obj->mask);
be_bryan 0:b74591d5ab33 99 }
be_bryan 0:b74591d5ab33 100 }
be_bryan 0:b74591d5ab33 101
be_bryan 0:b74591d5ab33 102 #endif