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
|
#include <errno.h>
#include <sys/types.h>
#include <lib_AT91SAM7.h>
#include <os/pio_irq.h>
#include <os/dbgu.h>
#include <os/req_ctx.h>
#include <openpcd.h>
struct pioirq_state {
irq_handler_t *handlers[NR_PIO];
u_int32_t usbmask;
u_int32_t usb_throttled; /* atomic? */
};
static struct pioirq_state pirqs;
static void pio_irq_demux(void)
{
u_int32_t pio = AT91F_PIO_GetInterruptStatus(AT91C_BASE_PIOA);
u_int8_t send_usb = 0;
int i;
DEBUGPCRF("PIO_ISR_STATUS = 0x%08x", pio);
for (i = 0; i < NR_PIO; i++) {
if (pio & (1 << i) && pirqs.handlers[i])
pirqs.handlers[i](i);
if (pirqs.usbmask & (1 << i))
send_usb = 1;
}
if (send_usb && !pirqs.usb_throttled) {
struct req_ctx *irq_rctx;
irq_rctx = req_ctx_find_get(RCTX_STATE_FREE,
RCTX_STATE_PIOIRQ_BUSY);
if (!irq_rctx) {
/* we cannot disable the interrupt, since we have
* non-usb listeners */
pirqs.usb_throttled = 1;
} else {
struct openpcd_hdr *opcdh;
u_int32_t *regmask;
opcdh = (struct openpcd_hdr *) &irq_rctx->tx.data[0];
regmask = (u_int32_t *) (&irq_rctx->tx.data[0] + sizeof(*opcdh));
opcdh->cmd = OPENPCD_CMD_PIO_IRQ;
opcdh->reg = 0x00;
opcdh->flags = 0x00;
opcdh->val = 0x00;
irq_rctx->tx.tot_len = sizeof(*opcdh) + sizeof(u_int32_t);
req_ctx_set_state(irq_rctx, RCTX_STATE_UDP_EP3_PENDING);
}
}
AT91F_AIC_ClearIt(AT91C_BASE_AIC, AT91C_ID_PIOA);
}
void pio_irq_enable(u_int32_t pio)
{
AT91F_PIO_InterruptEnable(AT91C_BASE_PIOA, pio);
}
void pio_irq_disable(u_int32_t pio)
{
AT91F_PIO_InterruptDisable(AT91C_BASE_PIOA, pio);
}
int pio_irq_register(u_int32_t pio, irq_handler_t *handler)
{
u_int8_t num = ffs(pio);
if (num == 0)
return -EINVAL;
num--;
if (pirqs.handlers[num])
return -EBUSY;
pio_irq_disable(pio);
AT91F_PIO_CfgInput(AT91C_BASE_PIOA, pio);
pirqs.handlers[num] = handler;
return 0;
}
void pio_irq_unregister(u_int32_t pio)
{
u_int8_t num = ffs(pio);
if (num == 0)
return;
num--;
pio_irq_disable(pio);
pirqs.handlers[num] = NULL;
}
static int pio_irq_usb_in(struct req_ctx *rctx)
{
struct openpcd_hdr *poh = (struct openpcd_hdr *) &rctx->rx.data[0];
struct openpcd_hdr *pih = (struct openpcd_hdr *) &rctx->tx.data[0];
switch (poh->cmd) {
case OPENPCD_CMD_PIO_IRQ:
pirqs.usbmask = poh->val;
break;
default:
DEBUGP("UNKNOWN ");
return -EINVAL;
}
return 0;
}
void pio_irq_init(void)
{
AT91F_PIOA_CfgPMC();
AT91F_AIC_ConfigureIt(AT91C_BASE_AIC, AT91C_ID_PIOA,
AT91C_AIC_PRIOR_LOWEST,
AT91C_AIC_SRCTYPE_INT_HIGH_LEVEL, &pio_irq_demux);
AT91F_AIC_EnableIt(AT91C_BASE_AIC, AT91C_ID_PIOA);
}
|
