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"
|
---|
19 | #include "gpio_addrdefine.h"
|
---|
20 |
|
---|
21 | PinName port_pin(PortName port, int pin_n) {
|
---|
22 | return (PinName)((port*0x10)+pin_n);
|
---|
23 | }
|
---|
24 |
|
---|
25 | void port_init(port_t *obj, PortName port, int mask, PinDirection dir) {
|
---|
26 | uint32_t i;
|
---|
27 |
|
---|
28 | obj->port = port;
|
---|
29 | obj->mask = mask;
|
---|
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);
|
---|
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) {
|
---|
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;
|
---|
68 | }
|
---|
69 | }
|
---|
70 |
|
---|
71 | void port_write(port_t *obj, int value) {
|
---|
72 | *obj->reg_out = (obj->mask << 16) | (value & obj->mask);
|
---|
73 | }
|
---|
74 |
|
---|
75 | int port_read(port_t *obj) {
|
---|
76 | return (*obj->reg_in & obj->mask);
|
---|
77 | }
|
---|