1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18#include <linux/kernel.h>
19#include <linux/uwb/umc.h>
20
21#include "../../wusbcore/wusbhc.h"
22
23#include "whcd.h"
24
25static void transfer_done(struct whc *whc)
26{
27 queue_work(whc->workqueue, &whc->async_work);
28 queue_work(whc->workqueue, &whc->periodic_work);
29}
30
31irqreturn_t whc_int_handler(struct usb_hcd *hcd)
32{
33 struct wusbhc *wusbhc = usb_hcd_to_wusbhc(hcd);
34 struct whc *whc = wusbhc_to_whc(wusbhc);
35 u32 sts;
36
37 sts = le_readl(whc->base + WUSBSTS);
38 if (!(sts & WUSBSTS_INT_MASK))
39 return IRQ_NONE;
40 le_writel(sts & WUSBSTS_INT_MASK, whc->base + WUSBSTS);
41
42 if (sts & WUSBSTS_GEN_CMD_DONE)
43 wake_up(&whc->cmd_wq);
44
45 if (sts & WUSBSTS_HOST_ERR)
46 dev_err(&whc->umc->dev, "FIXME: host system error\n");
47
48 if (sts & WUSBSTS_ASYNC_SCHED_SYNCED)
49 wake_up(&whc->async_list_wq);
50
51 if (sts & WUSBSTS_PERIODIC_SCHED_SYNCED)
52 wake_up(&whc->periodic_list_wq);
53
54 if (sts & WUSBSTS_DNTS_INT)
55 queue_work(whc->workqueue, &whc->dn_work);
56
57
58
59
60
61 if (sts & (WUSBSTS_INT | WUSBSTS_ERR_INT))
62 transfer_done(whc);
63
64 return IRQ_HANDLED;
65}
66
67static int process_dn_buf(struct whc *whc)
68{
69 struct wusbhc *wusbhc = &whc->wusbhc;
70 struct dn_buf_entry *dn;
71 int processed = 0;
72
73 for (dn = whc->dn_buf; dn < whc->dn_buf + WHC_N_DN_ENTRIES; dn++) {
74 if (dn->status & WHC_DN_STATUS_VALID) {
75 wusbhc_handle_dn(wusbhc, dn->src_addr,
76 (struct wusb_dn_hdr *)dn->dn_data,
77 dn->msg_size);
78 dn->status &= ~WHC_DN_STATUS_VALID;
79 processed++;
80 }
81 }
82 return processed;
83}
84
85void whc_dn_work(struct work_struct *work)
86{
87 struct whc *whc = container_of(work, struct whc, dn_work);
88 int processed;
89
90 do {
91 processed = process_dn_buf(whc);
92 } while (processed);
93}
94