test

Committer:
elijahsj
Date:
Mon Nov 09 00:33:19 2020 -0500
Revision:
2:4364577b5ad8
Parent:
1:8a094db1347f
copied mbed library

Who changed what in which revision?

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