[352] | 1 | /* mbed Microcontroller Library
|
---|
| 2 | * Copyright (c) 2006-2013 ARM Limited
|
---|
| 3 | *
|
---|
| 4 | * Licensed under the Apache License, Version 2.0 (the "License");
|
---|
| 5 | * you may not use this file except in compliance with the License.
|
---|
| 6 | * You may obtain a copy of the License at
|
---|
| 7 | *
|
---|
| 8 | * http://www.apache.org/licenses/LICENSE-2.0
|
---|
| 9 | *
|
---|
| 10 | * Unless required by applicable law or agreed to in writing, software
|
---|
| 11 | * distributed under the License is distributed on an "AS IS" BASIS,
|
---|
| 12 | * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
---|
| 13 | * See the License for the specific language governing permissions and
|
---|
| 14 | * limitations under the License.
|
---|
| 15 | */
|
---|
| 16 | #include "port_api.h"
|
---|
| 17 | #include "pinmap.h"
|
---|
| 18 | #include "gpio_api.h"
|
---|
[374] | 19 | #include "gpio_addrdefine.h"
|
---|
[352] | 20 |
|
---|
| 21 | PinName port_pin(PortName port, int pin_n) {
|
---|
[374] | 22 | return (PinName)((port*0x10)+pin_n);
|
---|
[352] | 23 | }
|
---|
| 24 |
|
---|
| 25 | void port_init(port_t *obj, PortName port, int mask, PinDirection dir) {
|
---|
[374] | 26 | uint32_t i;
|
---|
| 27 |
|
---|
[352] | 28 | obj->port = port;
|
---|
| 29 | obj->mask = mask;
|
---|
[374] | 30 | obj->reg_dir = (volatile uint32_t *)PMSR(port);
|
---|
| 31 | obj->reg_out = (volatile uint32_t *)PORT(port);
|
---|
| 32 | obj->reg_in = (volatile uint32_t *)PPR(port);
|
---|
| 33 | obj->reg_buf = (volatile uint32_t *)PIBC(port);
|
---|
[352] | 34 | // Do not use masking, because it prevents the use of the unmasked pins
|
---|
| 35 | // port_reg->FIOMASK = ~mask;
|
---|
| 36 |
|
---|
| 37 | // The function is set per pin: reuse gpio logic
|
---|
| 38 | for (i=0; i<32; i++) {
|
---|
| 39 | if (obj->mask & (1<<i)) {
|
---|
| 40 | gpio_set(port_pin(obj->port, i));
|
---|
| 41 | }
|
---|
| 42 | }
|
---|
| 43 |
|
---|
| 44 | port_dir(obj, dir);
|
---|
| 45 | }
|
---|
| 46 |
|
---|
| 47 | void port_mode(port_t *obj, PinMode mode) {
|
---|
| 48 | uint32_t i;
|
---|
| 49 | // The mode is set per pin: reuse pinmap logic
|
---|
| 50 | for (i=0; i<32; i++) {
|
---|
| 51 | if (obj->mask & (1<<i)) {
|
---|
| 52 | pin_mode(port_pin(obj->port, i), mode);
|
---|
| 53 | }
|
---|
| 54 | }
|
---|
| 55 | }
|
---|
| 56 |
|
---|
| 57 | void port_dir(port_t *obj, PinDirection dir) {
|
---|
| 58 | switch (dir) {
|
---|
[374] | 59 | case PIN_INPUT : *obj->reg_dir = (obj->mask << 16) | obj->mask;
|
---|
| 60 | *obj->reg_buf |= obj->mask;
|
---|
| 61 | break;
|
---|
| 62 | case PIN_OUTPUT: *obj->reg_dir = (obj->mask << 16) | ~obj->mask;
|
---|
| 63 | *obj->reg_buf &= ~obj->mask;
|
---|
| 64 | break;
|
---|
| 65 | default:
|
---|
| 66 | // do nothing
|
---|
| 67 | break;
|
---|
[352] | 68 | }
|
---|
| 69 | }
|
---|
| 70 |
|
---|
| 71 | void port_write(port_t *obj, int value) {
|
---|
[374] | 72 | *obj->reg_out = (obj->mask << 16) | (value & obj->mask);
|
---|
[352] | 73 | }
|
---|
| 74 |
|
---|
| 75 | int port_read(port_t *obj) {
|
---|
| 76 | return (*obj->reg_in & obj->mask);
|
---|
| 77 | }
|
---|