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