blob: e0d55fbf31bf6eb4223ba8c35c426ca15e015771 (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
|
/*
* gpio_ext.c
*
*/
#include "gpio_ext.h"
#include "com_task.h"
#include "errno.h"
extern const struct gpio_id *gpio_list;
static inline int port_type_to_int(PORT_Type *port)
{
switch ((int) port) {
case PORTA_BASE:
return 0;
case PORTB_BASE:
return 1;
case PORTC_BASE:
return 2;
case PORTD_BASE:
return 3;
case PORTE_BASE:
return 4;
default:
return -EINVAL;
}
}
/* returns GPIO index in gpio_list table and -EINVAL
* if there is no entry for this gpio.
*/
static int is_gpio_valid(uint8_t pin)
{
uint16_t i;
int temp;
if (pin == 0xFF)
return -EINVAL;
for (i = 0; i < sizeof(gpio_list)/sizeof(struct gpio_id); i++){
temp = port_type_to_int(gpio_list[i].port) * 32;
temp += gpio_list[i].pin;
if ( temp == pin ) {
return i;
}
if (temp > pin)
return -EINVAL;
}
return -EINVAL;
}
static int set_gpio_status(uint8_t status, int index)
{
gpio_pin_config_t gpio_config;
gpio_config.pinDirection = (status & APALIS_TK1_K20_GPIO_STA_OE) ? kGPIO_DigitalOutput : kGPIO_DigitalInput;
gpio_config.outputLogic = (status & APALIS_TK1_K20_GPIO_STA_VAL);
if (index >= 0)
GPIO_PinInit(gpio_list[index].gpio, gpio_list[index].pin, &gpio_config);
else
return index;
return 0;
}
static uint8_t get_gpio_status(int index)
{
uint8_t status;
GPIO_Type *base;
uint32_t gpio_pin;
if (index == -EINVAL)
return 0xFF;
base = gpio_list[index].gpio;
gpio_pin = gpio_list[index].pin;
if (((base->PDDR) >> gpio_pin) & 0x01U) {
status = APALIS_TK1_K20_GPIO_STA_OE;
status += (((base->PDOR) >> gpio_pin) & 0x01U) ? APALIS_TK1_K20_GPIO_STA_VAL : 0x00;
} else {
status = 0x00;
status += (((base->PDIR) >> gpio_pin) & 0x01U) ? APALIS_TK1_K20_GPIO_STA_VAL : 0x00;
}
return status;
}
int gpio_registers(dspi_transfer_t *spi_transfer)
{
uint8_t *rx_buf = spi_transfer->rxData;
int index;
if (rx_buf[0] == APALIS_TK1_K20_WRITE_INST) {
switch (rx_buf[1]) {
case APALIS_TK1_K20_GPIOREG:
return -ENOENT;
break;
case APALIS_TK1_K20_GPIO_NO:
index = is_gpio_valid(rx_buf[2]);
if (index >= 0){
registers[APALIS_TK1_K20_GPIO_NO]= rx_buf[2];
registers[APALIS_TK1_K20_GPIO_STA] = get_gpio_status(index);
return 1;
} else {
registers[APALIS_TK1_K20_GPIO_NO] = 0xFF;
return -ENOENT;
}
break;
case APALIS_TK1_K20_GPIO_STA:
index = is_gpio_valid(registers[APALIS_TK1_K20_GPIO_NO]);
if (index >= 0){
set_gpio_status(rx_buf[2], index);
registers[APALIS_TK1_K20_GPIO_STA] = get_gpio_status(index);
return 1;
} else {
return -ENOENT;
}
break;
default:
return -ENOENT;
}
}
return -ENOENT;
}
|
