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) 2006-2013 ARM Limited
be_bryan 0:b74591d5ab33 3 *
be_bryan 0:b74591d5ab33 4 * Licensed under the Apache License, Version 2.0 (the "License");
be_bryan 0:b74591d5ab33 5 * you may not use this file except in compliance with the License.
be_bryan 0:b74591d5ab33 6 * You may obtain a copy of the License at
be_bryan 0:b74591d5ab33 7 *
be_bryan 0:b74591d5ab33 8 * http://www.apache.org/licenses/LICENSE-2.0
be_bryan 0:b74591d5ab33 9 *
be_bryan 0:b74591d5ab33 10 * Unless required by applicable law or agreed to in writing, software
be_bryan 0:b74591d5ab33 11 * distributed under the License is distributed on an "AS IS" BASIS,
be_bryan 0:b74591d5ab33 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
be_bryan 0:b74591d5ab33 13 * See the License for the specific language governing permissions and
be_bryan 0:b74591d5ab33 14 * limitations under the License.
be_bryan 0:b74591d5ab33 15 *
be_bryan 0:b74591d5ab33 16 * Ported to NXP LPC43XX by Micromint USA <support@micromint.com>
be_bryan 0:b74591d5ab33 17 */
be_bryan 0:b74591d5ab33 18 #include "mbed_assert.h"
be_bryan 0:b74591d5ab33 19 #include "port_api.h"
be_bryan 0:b74591d5ab33 20 #include "pinmap.h"
be_bryan 0:b74591d5ab33 21 #include "gpio_api.h"
be_bryan 0:b74591d5ab33 22
be_bryan 0:b74591d5ab33 23 // Lookup table to determine SCU offset for GPIO [port][pin]
be_bryan 0:b74591d5ab33 24 // Supports eight 16-bit ports to limit table size
be_bryan 0:b74591d5ab33 25 #define _SO(MBED_PIN) (MBED_PIN >> 18)
be_bryan 0:b74591d5ab33 26
be_bryan 0:b74591d5ab33 27 static const uint8_t _scu_off[][16] =
be_bryan 0:b74591d5ab33 28 { // GPIO0 to GPIO3
be_bryan 0:b74591d5ab33 29 { _SO(GPIO0_0), _SO(GPIO0_1), _SO(GPIO0_2), _SO(GPIO0_3),
be_bryan 0:b74591d5ab33 30 _SO(GPIO0_4), _SO(GPIO0_5), _SO(GPIO0_6), _SO(GPIO0_7),
be_bryan 0:b74591d5ab33 31 _SO(GPIO0_8), _SO(GPIO0_9), _SO(GPIO0_10), _SO(GPIO0_11),
be_bryan 0:b74591d5ab33 32 _SO(GPIO0_12), _SO(GPIO0_13), _SO(GPIO0_14), _SO(GPIO0_15)
be_bryan 0:b74591d5ab33 33 },
be_bryan 0:b74591d5ab33 34 { _SO(GPIO1_0), _SO(GPIO1_1), _SO(GPIO1_2), _SO(GPIO1_3),
be_bryan 0:b74591d5ab33 35 _SO(GPIO1_4), _SO(GPIO1_5), _SO(GPIO1_6), _SO(GPIO1_7),
be_bryan 0:b74591d5ab33 36 _SO(GPIO1_8), _SO(GPIO1_9), _SO(GPIO1_10), _SO(GPIO1_11),
be_bryan 0:b74591d5ab33 37 _SO(GPIO1_12), _SO(GPIO1_13), _SO(GPIO1_14), _SO(GPIO1_15)
be_bryan 0:b74591d5ab33 38 },
be_bryan 0:b74591d5ab33 39 { _SO(GPIO2_0), _SO(GPIO2_1), _SO(GPIO2_2), _SO(GPIO2_3),
be_bryan 0:b74591d5ab33 40 _SO(GPIO2_4), _SO(GPIO2_5), _SO(GPIO2_6), _SO(GPIO2_7),
be_bryan 0:b74591d5ab33 41 _SO(GPIO2_8), _SO(GPIO2_9), _SO(GPIO2_10), _SO(GPIO2_11),
be_bryan 0:b74591d5ab33 42 _SO(GPIO2_12), _SO(GPIO2_13), _SO(GPIO2_14), _SO(GPIO2_15)
be_bryan 0:b74591d5ab33 43 },
be_bryan 0:b74591d5ab33 44 { _SO(GPIO3_0), _SO(GPIO3_1), _SO(GPIO3_2), _SO(GPIO3_3),
be_bryan 0:b74591d5ab33 45 _SO(GPIO3_4), _SO(GPIO3_5), _SO(GPIO3_6), _SO(GPIO3_7),
be_bryan 0:b74591d5ab33 46 _SO(GPIO3_8), _SO(GPIO3_9), _SO(GPIO3_10), _SO(GPIO3_11),
be_bryan 0:b74591d5ab33 47 _SO(GPIO3_12), _SO(GPIO3_13), _SO(GPIO3_14), _SO(GPIO3_15)
be_bryan 0:b74591d5ab33 48 },
be_bryan 0:b74591d5ab33 49 };
be_bryan 0:b74591d5ab33 50
be_bryan 0:b74591d5ab33 51 // Use alternate encoding for ports 4 to 7 so lookup stays within uint8
be_bryan 0:b74591d5ab33 52 #define _S2(MBED_PIN) (((MBED_PIN >> 19) & 0xf0) | ((MBED_PIN >> 18) & 0x0f))
be_bryan 0:b74591d5ab33 53
be_bryan 0:b74591d5ab33 54 static const uint8_t _scu_off2[][16] =
be_bryan 0:b74591d5ab33 55 { // GPIO4 to GPIO7
be_bryan 0:b74591d5ab33 56 { _S2(GPIO4_0), _S2(GPIO4_1), _S2(GPIO4_2), _S2(GPIO4_3),
be_bryan 0:b74591d5ab33 57 _S2(GPIO4_4), _S2(GPIO4_5), _S2(GPIO4_6), _S2(GPIO4_7),
be_bryan 0:b74591d5ab33 58 _S2(GPIO4_8), _S2(GPIO4_9), _S2(GPIO4_10), _S2(GPIO4_11),
be_bryan 0:b74591d5ab33 59 _S2(GPIO4_12), _S2(GPIO4_13), _S2(GPIO4_14), _S2(GPIO4_15)
be_bryan 0:b74591d5ab33 60 },
be_bryan 0:b74591d5ab33 61 { _S2(GPIO5_0), _S2(GPIO5_1), _S2(GPIO5_2), _S2(GPIO5_3),
be_bryan 0:b74591d5ab33 62 _S2(GPIO5_4), _S2(GPIO5_5), _S2(GPIO5_6), _S2(GPIO5_7),
be_bryan 0:b74591d5ab33 63 _S2(GPIO5_8), _S2(GPIO5_9), _S2(GPIO5_10), _S2(GPIO5_11),
be_bryan 0:b74591d5ab33 64 _S2(GPIO5_12), _S2(GPIO5_13), _S2(GPIO5_14), _S2(GPIO5_15)
be_bryan 0:b74591d5ab33 65 },
be_bryan 0:b74591d5ab33 66 { _S2(GPIO6_0), _S2(GPIO6_1), _S2(GPIO6_2), _S2(GPIO6_3),
be_bryan 0:b74591d5ab33 67 _S2(GPIO6_4), _S2(GPIO6_5), _S2(GPIO6_6), _S2(GPIO6_7),
be_bryan 0:b74591d5ab33 68 _S2(GPIO6_8), _S2(GPIO6_9), _S2(GPIO6_10), _S2(GPIO6_11),
be_bryan 0:b74591d5ab33 69 _S2(GPIO6_12), _S2(GPIO6_13), _S2(GPIO6_14), _S2(GPIO6_15)
be_bryan 0:b74591d5ab33 70 },
be_bryan 0:b74591d5ab33 71 { _S2(GPIO7_0), _S2(GPIO7_1), _S2(GPIO7_2), _S2(GPIO7_3),
be_bryan 0:b74591d5ab33 72 _S2(GPIO7_4), _S2(GPIO7_5), _S2(GPIO7_6), _S2(GPIO7_7),
be_bryan 0:b74591d5ab33 73 _S2(GPIO7_8), _S2(GPIO7_9), _S2(GPIO7_10), _S2(GPIO7_11),
be_bryan 0:b74591d5ab33 74 _S2(GPIO7_12), _S2(GPIO7_13), _S2(GPIO7_14), _S2(GPIO7_15)
be_bryan 0:b74591d5ab33 75 },
be_bryan 0:b74591d5ab33 76 };
be_bryan 0:b74591d5ab33 77
be_bryan 0:b74591d5ab33 78 PinName port_pin(PortName port, int pin_n) {
be_bryan 0:b74591d5ab33 79 MBED_ASSERT((port <= Port7) && (pin_n < 32));
be_bryan 0:b74591d5ab33 80 int offset = 0;
be_bryan 0:b74591d5ab33 81
be_bryan 0:b74591d5ab33 82 // Lookup table only maps pins 0 to 15
be_bryan 0:b74591d5ab33 83 if (pin_n > 15) {
be_bryan 0:b74591d5ab33 84 return NC;
be_bryan 0:b74591d5ab33 85 }
be_bryan 0:b74591d5ab33 86
be_bryan 0:b74591d5ab33 87 // Lookup SCU offset
be_bryan 0:b74591d5ab33 88 if (port < Port4) {
be_bryan 0:b74591d5ab33 89 offset = _scu_off[port][pin_n];
be_bryan 0:b74591d5ab33 90 } else {
be_bryan 0:b74591d5ab33 91 offset = _scu_off2[port - Port4][pin_n];
be_bryan 0:b74591d5ab33 92 offset = ((offset & 0xf0) << 1) | (offset & 0x0f);
be_bryan 0:b74591d5ab33 93 }
be_bryan 0:b74591d5ab33 94
be_bryan 0:b74591d5ab33 95 // Return pin name
be_bryan 0:b74591d5ab33 96 return (PinName)((offset << 18) | GPIO_OFF(port, pin_n));
be_bryan 0:b74591d5ab33 97 }
be_bryan 0:b74591d5ab33 98
be_bryan 0:b74591d5ab33 99 void port_init(port_t *obj, PortName port, int mask, PinDirection dir) {
be_bryan 0:b74591d5ab33 100 obj->port = port;
be_bryan 0:b74591d5ab33 101 obj->mask = mask;
be_bryan 0:b74591d5ab33 102
be_bryan 0:b74591d5ab33 103 LPC_GPIO_T *port_reg = (LPC_GPIO_T *)(LPC_GPIO_PORT_BASE);
be_bryan 0:b74591d5ab33 104
be_bryan 0:b74591d5ab33 105 // Do not use masking, because it prevents the use of the unmasked pins
be_bryan 0:b74591d5ab33 106 // port_reg->MASK[port] = ~mask;
be_bryan 0:b74591d5ab33 107
be_bryan 0:b74591d5ab33 108 obj->reg_out = &port_reg->PIN[port];
be_bryan 0:b74591d5ab33 109 obj->reg_in = &port_reg->PIN[port];
be_bryan 0:b74591d5ab33 110 obj->reg_dir = &port_reg->DIR[port];
be_bryan 0:b74591d5ab33 111
be_bryan 0:b74591d5ab33 112 uint32_t i;
be_bryan 0:b74591d5ab33 113 // The function is set per pin: reuse gpio logic
be_bryan 0:b74591d5ab33 114 for (i=0; i<32; i++) {
be_bryan 0:b74591d5ab33 115 if (obj->mask & (1<<i)) {
be_bryan 0:b74591d5ab33 116 gpio_set(port_pin(obj->port, i));
be_bryan 0:b74591d5ab33 117 }
be_bryan 0:b74591d5ab33 118 }
be_bryan 0:b74591d5ab33 119
be_bryan 0:b74591d5ab33 120 port_dir(obj, dir);
be_bryan 0:b74591d5ab33 121 }
be_bryan 0:b74591d5ab33 122
be_bryan 0:b74591d5ab33 123 void port_mode(port_t *obj, PinMode mode) {
be_bryan 0:b74591d5ab33 124 uint32_t i;
be_bryan 0:b74591d5ab33 125 // The mode is set per pin: reuse pinmap logic
be_bryan 0:b74591d5ab33 126 for (i=0; i<32; i++) {
be_bryan 0:b74591d5ab33 127 if (obj->mask & (1<<i)) {
be_bryan 0:b74591d5ab33 128 pin_mode(port_pin(obj->port, i), mode);
be_bryan 0:b74591d5ab33 129 }
be_bryan 0:b74591d5ab33 130 }
be_bryan 0:b74591d5ab33 131 }
be_bryan 0:b74591d5ab33 132
be_bryan 0:b74591d5ab33 133 void port_dir(port_t *obj, PinDirection dir) {
be_bryan 0:b74591d5ab33 134 switch (dir) {
be_bryan 0:b74591d5ab33 135 case PIN_INPUT : *obj->reg_dir &= ~obj->mask; break;
be_bryan 0:b74591d5ab33 136 case PIN_OUTPUT: *obj->reg_dir |= obj->mask; break;
be_bryan 0:b74591d5ab33 137 }
be_bryan 0:b74591d5ab33 138 }
be_bryan 0:b74591d5ab33 139
be_bryan 0:b74591d5ab33 140 void port_write(port_t *obj, int value) {
be_bryan 0:b74591d5ab33 141 *obj->reg_out = (*obj->reg_in & ~obj->mask) | (value & obj->mask);
be_bryan 0:b74591d5ab33 142 }
be_bryan 0:b74591d5ab33 143
be_bryan 0:b74591d5ab33 144 int port_read(port_t *obj) {
be_bryan 0:b74591d5ab33 145 return (*obj->reg_in & obj->mask);
be_bryan 0:b74591d5ab33 146 }