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 = devm_request_irq(dev, 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}
176
177
178
179
180int usbhs_status_get_device_state(struct usbhs_irq_state *irq_state)
181{
182 int state = irq_state->intsts0 & DVSQ_MASK;
183
184 switch (state) {
185 case POWER_STATE:
186 case DEFAULT_STATE:
187 case ADDRESS_STATE:
188 case CONFIGURATION_STATE:
189 return state;
190 }
191
192 return -EIO;
193}
194
195int usbhs_status_get_ctrl_stage(struct usbhs_irq_state *irq_state)
196{
197
198
199
200
201
202
203
204
205
206
207
208 return (int)irq_state->intsts0 & CTSQ_MASK;
209}
210
211static int usbhs_status_get_each_irq(struct usbhs_priv *priv,
212 struct usbhs_irq_state *state)
213{
214 struct usbhs_mod *mod = usbhs_mod_get_current(priv);
215 u16 intenb0, intenb1;
216 unsigned long flags;
217
218
219 usbhs_lock(priv, flags);
220 state->intsts0 = usbhs_read(priv, INTSTS0);
221 intenb0 = usbhs_read(priv, INTENB0);
222
223 if (usbhs_mod_is_host(priv)) {
224 state->intsts1 = usbhs_read(priv, INTSTS1);
225 intenb1 = usbhs_read(priv, INTENB1);
226 } else {
227 state->intsts1 = intenb1 = 0;
228 }
229
230
231 if (mod) {
232 state->brdysts = usbhs_read(priv, BRDYSTS);
233 state->nrdysts = usbhs_read(priv, NRDYSTS);
234 state->bempsts = usbhs_read(priv, BEMPSTS);
235
236 state->bempsts &= mod->irq_bempsts;
237 state->brdysts &= mod->irq_brdysts;
238 }
239 usbhs_unlock(priv, flags);
240
241
242
243
244
245
246 if (priv->irqflags & IRQF_SHARED) {
247 if (!(intenb0 & state->intsts0) &&
248 !(intenb1 & state->intsts1) &&
249 !(state->bempsts) &&
250 !(state->brdysts))
251 return -EIO;
252 }
253
254 return 0;
255}
256
257
258
259
260#define INTSTS0_MAGIC 0xF800
261#define INTSTS1_MAGIC 0xA870
262static irqreturn_t usbhs_interrupt(int irq, void *data)
263{
264 struct usbhs_priv *priv = data;
265 struct usbhs_irq_state irq_state;
266
267 if (usbhs_status_get_each_irq(priv, &irq_state) < 0)
268 return IRQ_NONE;
269
270
271
272
273
274
275
276
277
278
279
280
281 usbhs_write(priv, INTSTS0, ~irq_state.intsts0 & INTSTS0_MAGIC);
282 if (usbhs_mod_is_host(priv))
283 usbhs_write(priv, INTSTS1, ~irq_state.intsts1 & INTSTS1_MAGIC);
284
285
286
287
288
289
290 if (irq_state.intsts0 & BRDY)
291 usbhs_write(priv, BRDYSTS, ~irq_state.brdysts);
292 usbhs_write(priv, NRDYSTS, ~irq_state.nrdysts);
293 if (irq_state.intsts0 & BEMP)
294 usbhs_write(priv, BEMPSTS, ~irq_state.bempsts);
295
296
297
298
299
300
301
302
303 if (irq_state.intsts0 & VBINT)
304 usbhs_mod_info_call(priv, irq_vbus, priv, &irq_state);
305
306 if (irq_state.intsts0 & DVST)
307 usbhs_mod_call(priv, irq_dev_state, priv, &irq_state);
308
309 if (irq_state.intsts0 & CTRT)
310 usbhs_mod_call(priv, irq_ctrl_stage, priv, &irq_state);
311
312 if (irq_state.intsts0 & BEMP)
313 usbhs_mod_call(priv, irq_empty, priv, &irq_state);
314
315 if (irq_state.intsts0 & BRDY)
316 usbhs_mod_call(priv, irq_ready, priv, &irq_state);
317
318 if (usbhs_mod_is_host(priv)) {
319
320 if (irq_state.intsts1 & ATTCH)
321 usbhs_mod_call(priv, irq_attch, priv, &irq_state);
322
323 if (irq_state.intsts1 & DTCH)
324 usbhs_mod_call(priv, irq_dtch, priv, &irq_state);
325
326 if (irq_state.intsts1 & SIGN)
327 usbhs_mod_call(priv, irq_sign, priv, &irq_state);
328
329 if (irq_state.intsts1 & SACK)
330 usbhs_mod_call(priv, irq_sack, priv, &irq_state);
331 }
332 return IRQ_HANDLED;
333}
334
335void usbhs_irq_callback_update(struct usbhs_priv *priv, struct usbhs_mod *mod)
336{
337 u16 intenb0 = 0;
338 u16 intenb1 = 0;
339 struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
340
341
342
343
344
345
346
347
348
349 usbhs_write(priv, INTENB0, 0);
350 if (usbhs_mod_is_host(priv))
351 usbhs_write(priv, INTENB1, 0);
352
353 usbhs_write(priv, BEMPENB, 0);
354 usbhs_write(priv, BRDYENB, 0);
355
356
357
358
359
360
361
362
363
364
365 if (info->irq_vbus)
366 intenb0 |= VBSE;
367
368 if (mod) {
369
370
371
372 if (mod->irq_ctrl_stage)
373 intenb0 |= CTRE;
374
375 if (mod->irq_empty && mod->irq_bempsts) {
376 usbhs_write(priv, BEMPENB, mod->irq_bempsts);
377 intenb0 |= BEMPE;
378 }
379
380 if (mod->irq_ready && mod->irq_brdysts) {
381 usbhs_write(priv, BRDYENB, mod->irq_brdysts);
382 intenb0 |= BRDYE;
383 }
384
385 if (usbhs_mod_is_host(priv)) {
386
387
388
389 if (mod->irq_attch)
390 intenb1 |= ATTCHE;
391
392 if (mod->irq_dtch)
393 intenb1 |= DTCHE;
394
395 if (mod->irq_sign)
396 intenb1 |= SIGNE;
397
398 if (mod->irq_sack)
399 intenb1 |= SACKE;
400 }
401 }
402
403 if (intenb0)
404 usbhs_write(priv, INTENB0, intenb0);
405
406 if (usbhs_mod_is_host(priv) && intenb1)
407 usbhs_write(priv, INTENB1, intenb1);
408}
409