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
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
|
/***************************************************************************
* __________ __ ___.
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
* \/ \/ \/ \/ \/
* $Id$
*
* Copyright (C) 2014 Cástor Muñoz
* Code based on openiBoot project
*
* This program is free software; you can redistribute it and/or
* modify it under the terms of the GNU General Public License
* as published by the Free Software Foundation; either version 2
* of the License, or (at your option) any later version.
*
* This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
* KIND, either express or implied.
*
****************************************************************************/
#include <stdint.h>
#include "config.h"
#include "system.h"
#include "gpio-s5l8702.h"
#include "panic.h"
int rec_hw_ver;
void INIT_ATTR gpio_init(void)
{
/* Capture hardware versions:
*
* HW version 1 includes an amplifier for the jack plug
* microphone, it is activated configuring GPIO E7 as output
* high. It is posible to detect capture HW version (even
* when HP are not plugged) reading GPIO E7:
*
* Ver GPIO E7 models capture support
* --- ------- ------ ---------------
* 0 1 80/160fat dock line-in
* 1 0 120/160slim dock line-in + jack mic
*/
GPIOCMD = 0xe0700;
rec_hw_ver = (PDAT(14) & (1 << 7)) ? 0 : 1;
/* default GPIO configuration */
GPIOCMD = 0xe070e;
if (rec_hw_ver == 0) {
GPIOCMD = 0xe060e;
}
else {
/* GPIO E6 is connected to mikey IRQ line (active low),
configure it as pull-up input */
GPIOCMD = 0xe0600;
PUNB(14) |= (1 << 6);
}
/* TODO: initialize GPIO ports for minimum power consumption */
}
/*
* XXX: disabled, not used and never tested!
*/
#if 0
/* handlers list */
#define GPIOIC_MAX_HANDLERS 2
#define FLAG_TYPE_LEVEL (1 << 0)
#define FLAG_AUTOFLIP (1 << 1)
struct gpio_handler {
int gpio_n;
void (*isr)(void);
int flags;
};
static struct gpio_handler l_handlers[GPIOIC_MAX_HANDLERS] IDATA_ATTR;
static int n_handlers = 0;
/* API */
uint32_t gpio_group_get(int group)
{
uint32_t pcon = PCON(group);
uint32_t pdat = PDAT(group);
uint32_t group_cfg = 0;
int i;
for (i = 0; i < 8; i++) {
int pin_cfg = pcon & 0xF;
if (pin_cfg == 1) /* output */
pin_cfg = 0xE | ((pdat >> i) & 1);
group_cfg = (group_cfg >> 4) | (pin_cfg << 28);
pcon >>= 4;
}
return group_cfg;
}
void gpio_group_set(int group, uint32_t mask, uint32_t cfg)
{
PCON(group) = (PCON(group) & ~mask) | (cfg & mask);
}
void gpio_int_register(int gpio_n, void *isr, int type, int level, int autoflip)
{
if (n_handlers >= GPIOIC_MAX_HANDLERS)
panicf("gpio_int_register(): too many handlers!");
int group = IC_GROUP(gpio_n);
int index = IC_IDX(gpio_n);
int flags = disable_irq_save();
/* fill handler struct */
struct gpio_handler *handler = &l_handlers[n_handlers++];
handler->gpio_n = gpio_n;
handler->isr = isr;
handler->flags = (type ? FLAG_TYPE_LEVEL : 0)
| (autoflip ? FLAG_AUTOFLIP : 0);
/* configure */
GPIOIC_INTTYPE(group) |=
(type ? GPIOIC_INTTYPE_LEVEL : GPIOIC_INTTYPE_EDGE) << index;
GPIOIC_INTLEVEL(group) |=
(level ? GPIOIC_INTLEVEL_HIGH : GPIOIC_INTLEVEL_LOW) << index;
restore_irq(flags);
/* XXX: valid only for gpio_n = 0..127 (IRQ_EXT0..IRQ_EXT3) */
VIC0INTENABLE = 1 << (IRQ_EXT0 + (gpio_n >> 5));
}
void gpio_int_enable(int gpio_n)
{
int group = IC_GROUP(gpio_n);
uint32_t bit_mask = 1 << IC_IDX(gpio_n);
int flags = disable_irq_save();
GPIOIC_INTSTAT(group) = bit_mask; /* clear */
GPIOIC_INTEN(group) |= bit_mask; /* enable */
restore_irq(flags);
}
void gpio_int_disable(int gpio_n)
{
int group = IC_GROUP(gpio_n);
uint32_t bit_mask = 1 << IC_IDX(gpio_n);
int flags = disable_irq_save();
GPIOIC_INTEN(group) &= ~bit_mask; /* disable */
GPIOIC_INTSTAT(group) = bit_mask; /* clear */
restore_irq(flags);
}
/* ISR */
void ICODE_ATTR gpio_handler(int group)
{
int i;
struct gpio_handler *handler;
uint32_t ints, bit_mask;
ints = GPIOIC_INTSTAT(group) & GPIOIC_INTEN(group);
for (i = 0; i < n_handlers; i++) {
handler = &l_handlers[i];
if (IC_GROUP(handler->gpio_n) != group)
continue;
bit_mask = 1 << IC_IDX(handler->gpio_n);
if (ints & bit_mask) {
if ((handler->flags & FLAG_TYPE_LEVEL) == 0)
GPIOIC_INTSTAT(group) = bit_mask; /* clear */
if (handler->flags & FLAG_AUTOFLIP)
GPIOIC_INTLEVEL(group) ^= bit_mask; /* swap level */
if (handler->isr)
handler->isr(); /* exec GPIO handler */
GPIOIC_INTSTAT(group) = bit_mask; /* clear */
}
}
}
void ICODE_ATTR INT_EXT0(void)
{
gpio_handler(6);
}
void ICODE_ATTR INT_EXT1(void)
{
gpio_handler(5);
}
void ICODE_ATTR INT_EXT2(void)
{
gpio_handler(4);
}
void ICODE_ATTR INT_EXT3(void)
{
gpio_handler(3);
}
void ICODE_ATTR INT_EXT6(void)
{
gpio_handler(0);
}
#endif
|
