1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17#include <linux/interrupt.h>
18
19#include "common.h"
20#include "mod.h"
21
22#define usbhs_priv_to_modinfo(priv) (&priv->mod_info)
23#define usbhs_mod_info_call(priv, func, param...) \
24({ \
25 struct usbhs_mod_info *info; \
26 info = usbhs_priv_to_modinfo(priv); \
27 !info->func ? 0 : \
28 info->func(param); \
29})
30
31
32
33
34
35
36
37
38
39
40
41static int usbhsm_autonomy_get_vbus(struct platform_device *pdev)
42{
43 struct usbhs_priv *priv = usbhs_pdev_to_priv(pdev);
44
45 return VBSTS & usbhs_read(priv, INTSTS0);
46}
47
48static int usbhsm_autonomy_irq_vbus(struct usbhs_priv *priv,
49 struct usbhs_irq_state *irq_state)
50{
51 struct platform_device *pdev = usbhs_priv_to_pdev(priv);
52
53 renesas_usbhs_call_notify_hotplug(pdev);
54
55 return 0;
56}
57
58void usbhs_mod_autonomy_mode(struct usbhs_priv *priv)
59{
60 struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
61
62 info->irq_vbus = usbhsm_autonomy_irq_vbus;
63 priv->pfunc.get_vbus = usbhsm_autonomy_get_vbus;
64
65 usbhs_irq_callback_update(priv, NULL);
66}
67
68
69
70
71
72
73
74
75void usbhs_mod_register(struct usbhs_priv *priv, struct usbhs_mod *mod, int id)
76{
77 struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
78
79 info->mod[id] = mod;
80 mod->priv = priv;
81}
82
83struct usbhs_mod *usbhs_mod_get(struct usbhs_priv *priv, int id)
84{
85 struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
86 struct usbhs_mod *ret = NULL;
87
88 switch (id) {
89 case USBHS_HOST:
90 case USBHS_GADGET:
91 ret = info->mod[id];
92 break;
93 }
94
95 return ret;
96}
97
98int usbhs_mod_is_host(struct usbhs_priv *priv)
99{
100 struct usbhs_mod *mod = usbhs_mod_get_current(priv);
101 struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
102
103 if (!mod)
104 return -EINVAL;
105
106 return info->mod[USBHS_HOST] == mod;
107}
108
109struct usbhs_mod *usbhs_mod_get_current(struct usbhs_priv *priv)
110{
111 struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
112
113 return info->curt;
114}
115
116int usbhs_mod_change(struct usbhs_priv *priv, int id)
117{
118 struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
119 struct usbhs_mod *mod = NULL;
120 int ret = 0;
121
122
123 switch (id) {
124 case USBHS_HOST:
125 case USBHS_GADGET:
126 mod = info->mod[id];
127 break;
128 default:
129 ret = -EINVAL;
130 }
131 info->curt = mod;
132
133 return ret;
134}
135
136static irqreturn_t usbhs_interrupt(int irq, void *data);
137int usbhs_mod_probe(struct usbhs_priv *priv)
138{
139 struct device *dev = usbhs_priv_to_dev(priv);
140 int ret;
141
142
143
144
145 ret = usbhs_mod_host_probe(priv);
146 if (ret < 0)
147 return ret;
148
149 ret = usbhs_mod_gadget_probe(priv);
150 if (ret < 0)
151 goto mod_init_host_err;
152
153
154 ret = request_irq(priv->irq, usbhs_interrupt,
155 priv->irqflags, dev_name(dev), priv);
156 if (ret) {
157 dev_err(dev, "irq request err\n");
158 goto mod_init_gadget_err;
159 }
160
161 return ret;
162
163mod_init_gadget_err:
164 usbhs_mod_gadget_remove(priv);
165mod_init_host_err:
166 usbhs_mod_host_remove(priv);
167
168 return ret;
169}
170
171void usbhs_mod_remove(struct usbhs_priv *priv)
172{
173 usbhs_mod_host_remove(priv);
174 usbhs_mod_gadget_remove(priv);
175 free_irq(priv->irq, priv);
176}
177
178
179
180
181int usbhs_status_get_device_state(struct usbhs_irq_state *irq_state)
182{
183 int state = irq_state->intsts0 & DVSQ_MASK;
184
185 switch (state) {
186 case POWER_STATE:
187 case DEFAULT_STATE:
188 case ADDRESS_STATE:
189 case CONFIGURATION_STATE:
190 return state;
191 }
192
193 return -EIO;
194}
195
196int usbhs_status_get_ctrl_stage(struct usbhs_irq_state *irq_state)
197{
198
199
200
201
202
203
204
205
206
207
208
209 return (int)irq_state->intsts0 & CTSQ_MASK;
210}
211
212static void usbhs_status_get_each_irq(struct usbhs_priv *priv,
213 struct usbhs_irq_state *state)
214{
215 struct usbhs_mod *mod = usbhs_mod_get_current(priv);
216
217 state->intsts0 = usbhs_read(priv, INTSTS0);
218 state->intsts1 = usbhs_read(priv, INTSTS1);
219
220
221 if (mod) {
222 state->brdysts = usbhs_read(priv, BRDYSTS);
223 state->nrdysts = usbhs_read(priv, NRDYSTS);
224 state->bempsts = usbhs_read(priv, BEMPSTS);
225
226 state->bempsts &= mod->irq_bempsts;
227 state->brdysts &= mod->irq_brdysts;
228 }
229}
230
231
232
233
234#define INTSTS0_MAGIC 0xF800
235#define INTSTS1_MAGIC 0xA870
236static irqreturn_t usbhs_interrupt(int irq, void *data)
237{
238 struct usbhs_priv *priv = data;
239 struct usbhs_irq_state irq_state;
240
241 usbhs_status_get_each_irq(priv, &irq_state);
242
243
244
245
246
247
248
249
250
251
252
253
254 usbhs_write(priv, INTSTS0, ~irq_state.intsts0 & INTSTS0_MAGIC);
255 usbhs_write(priv, INTSTS1, ~irq_state.intsts1 & INTSTS1_MAGIC);
256
257 usbhs_write(priv, BRDYSTS, 0);
258 usbhs_write(priv, NRDYSTS, 0);
259 usbhs_write(priv, BEMPSTS, 0);
260
261
262
263
264
265
266
267
268 if (irq_state.intsts0 & VBINT)
269 usbhs_mod_info_call(priv, irq_vbus, priv, &irq_state);
270
271 if (irq_state.intsts0 & DVST)
272 usbhs_mod_call(priv, irq_dev_state, priv, &irq_state);
273
274 if (irq_state.intsts0 & CTRT)
275 usbhs_mod_call(priv, irq_ctrl_stage, priv, &irq_state);
276
277 if (irq_state.intsts0 & BEMP)
278 usbhs_mod_call(priv, irq_empty, priv, &irq_state);
279
280 if (irq_state.intsts0 & BRDY)
281 usbhs_mod_call(priv, irq_ready, priv, &irq_state);
282
283
284 if (irq_state.intsts1 & ATTCH)
285 usbhs_mod_call(priv, irq_attch, priv, &irq_state);
286
287 if (irq_state.intsts1 & DTCH)
288 usbhs_mod_call(priv, irq_dtch, priv, &irq_state);
289
290 if (irq_state.intsts1 & SIGN)
291 usbhs_mod_call(priv, irq_sign, priv, &irq_state);
292
293 if (irq_state.intsts1 & SACK)
294 usbhs_mod_call(priv, irq_sack, priv, &irq_state);
295
296 return IRQ_HANDLED;
297}
298
299void usbhs_irq_callback_update(struct usbhs_priv *priv, struct usbhs_mod *mod)
300{
301 u16 intenb0 = 0;
302 u16 intenb1 = 0;
303 struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
304
305
306
307
308
309
310
311
312
313 usbhs_write(priv, INTENB0, 0);
314 usbhs_write(priv, INTENB1, 0);
315
316 usbhs_write(priv, BEMPENB, 0);
317 usbhs_write(priv, BRDYENB, 0);
318
319
320
321
322
323
324
325
326
327
328 if (info->irq_vbus)
329 intenb0 |= VBSE;
330
331 if (mod) {
332
333
334
335 if (mod->irq_ctrl_stage)
336 intenb0 |= CTRE;
337
338 if (mod->irq_empty && mod->irq_bempsts) {
339 usbhs_write(priv, BEMPENB, mod->irq_bempsts);
340 intenb0 |= BEMPE;
341 }
342
343 if (mod->irq_ready && mod->irq_brdysts) {
344 usbhs_write(priv, BRDYENB, mod->irq_brdysts);
345 intenb0 |= BRDYE;
346 }
347
348
349
350
351 if (mod->irq_attch)
352 intenb1 |= ATTCHE;
353
354 if (mod->irq_dtch)
355 intenb1 |= DTCHE;
356
357 if (mod->irq_sign)
358 intenb1 |= SIGNE;
359
360 if (mod->irq_sack)
361 intenb1 |= SACKE;
362 }
363
364 if (intenb0)
365 usbhs_write(priv, INTENB0, intenb0);
366
367 if (intenb1)
368 usbhs_write(priv, INTENB1, intenb1);
369}
370