Commit | Line | Data |
---|---|---|
f1407d5c KM |
1 | /* |
2 | * Renesas USB driver | |
3 | * | |
4 | * Copyright (C) 2011 Renesas Solutions Corp. | |
5 | * Kuninori Morimoto <kuninori.morimoto.gx@renesas.com> | |
6 | * | |
7 | * This program is distributed in the hope that it will be useful, | |
8 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
9 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
10 | * GNU General Public License for more details. | |
11 | * | |
12 | * You should have received a copy of the GNU General Public License | |
13 | * along with this program; if not, write to the Free Software | |
14 | * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA | |
15 | * | |
16 | */ | |
17 | #include <linux/delay.h> | |
f1407d5c | 18 | #include <linux/slab.h> |
cc502bb7 PB |
19 | #include "common.h" |
20 | #include "pipe.h" | |
f1407d5c KM |
21 | |
22 | /* | |
23 | * macros | |
24 | */ | |
f1407d5c KM |
25 | #define usbhsp_addr_offset(p) ((usbhs_pipe_number(p) - 1) * 2) |
26 | ||
f1407d5c KM |
27 | #define usbhsp_flags_set(p, f) ((p)->flags |= USBHS_PIPE_FLAGS_##f) |
28 | #define usbhsp_flags_clr(p, f) ((p)->flags &= ~USBHS_PIPE_FLAGS_##f) | |
29 | #define usbhsp_flags_has(p, f) ((p)->flags & USBHS_PIPE_FLAGS_##f) | |
30 | #define usbhsp_flags_init(p) do {(p)->flags = 0; } while (0) | |
31 | ||
f1407d5c KM |
32 | /* |
33 | * for debug | |
34 | */ | |
35 | static char *usbhsp_pipe_name[] = { | |
36 | [USB_ENDPOINT_XFER_CONTROL] = "DCP", | |
37 | [USB_ENDPOINT_XFER_BULK] = "BULK", | |
38 | [USB_ENDPOINT_XFER_INT] = "INT", | |
39 | [USB_ENDPOINT_XFER_ISOC] = "ISO", | |
40 | }; | |
41 | ||
3cf8ed12 KM |
42 | char *usbhs_pipe_name(struct usbhs_pipe *pipe) |
43 | { | |
44 | return usbhsp_pipe_name[usbhs_pipe_type(pipe)]; | |
45 | } | |
46 | ||
f1407d5c KM |
47 | /* |
48 | * DCPCTR/PIPEnCTR functions | |
49 | */ | |
50 | static void usbhsp_pipectrl_set(struct usbhs_pipe *pipe, u16 mask, u16 val) | |
51 | { | |
e8d548d5 | 52 | struct usbhs_priv *priv = usbhs_pipe_to_priv(pipe); |
f1407d5c KM |
53 | int offset = usbhsp_addr_offset(pipe); |
54 | ||
e8d548d5 | 55 | if (usbhs_pipe_is_dcp(pipe)) |
f1407d5c KM |
56 | usbhs_bset(priv, DCPCTR, mask, val); |
57 | else | |
58 | usbhs_bset(priv, PIPEnCTR + offset, mask, val); | |
59 | } | |
60 | ||
61 | static u16 usbhsp_pipectrl_get(struct usbhs_pipe *pipe) | |
62 | { | |
e8d548d5 | 63 | struct usbhs_priv *priv = usbhs_pipe_to_priv(pipe); |
f1407d5c KM |
64 | int offset = usbhsp_addr_offset(pipe); |
65 | ||
e8d548d5 | 66 | if (usbhs_pipe_is_dcp(pipe)) |
f1407d5c KM |
67 | return usbhs_read(priv, DCPCTR); |
68 | else | |
69 | return usbhs_read(priv, PIPEnCTR + offset); | |
70 | } | |
71 | ||
72 | /* | |
73 | * DCP/PIPE functions | |
74 | */ | |
75 | static void __usbhsp_pipe_xxx_set(struct usbhs_pipe *pipe, | |
76 | u16 dcp_reg, u16 pipe_reg, | |
77 | u16 mask, u16 val) | |
78 | { | |
e8d548d5 | 79 | struct usbhs_priv *priv = usbhs_pipe_to_priv(pipe); |
f1407d5c | 80 | |
e8d548d5 | 81 | if (usbhs_pipe_is_dcp(pipe)) |
f1407d5c KM |
82 | usbhs_bset(priv, dcp_reg, mask, val); |
83 | else | |
84 | usbhs_bset(priv, pipe_reg, mask, val); | |
85 | } | |
86 | ||
f1407d5c KM |
87 | /* |
88 | * DCPCFG/PIPECFG functions | |
89 | */ | |
90 | static void usbhsp_pipe_cfg_set(struct usbhs_pipe *pipe, u16 mask, u16 val) | |
91 | { | |
92 | __usbhsp_pipe_xxx_set(pipe, DCPCFG, PIPECFG, mask, val); | |
93 | } | |
94 | ||
1c90ee0b KM |
95 | /* |
96 | * PIPEnTRN/PIPEnTRE functions | |
97 | */ | |
98 | static void usbhsp_pipe_trn_set(struct usbhs_pipe *pipe, u16 mask, u16 val) | |
99 | { | |
100 | struct usbhs_priv *priv = usbhs_pipe_to_priv(pipe); | |
101 | struct device *dev = usbhs_priv_to_dev(priv); | |
102 | int num = usbhs_pipe_number(pipe); | |
103 | u16 reg; | |
104 | ||
105 | /* | |
106 | * It is impossible to calculate address, | |
107 | * since PIPEnTRN addresses were mapped randomly. | |
108 | */ | |
109 | #define CASE_PIPExTRN(a) \ | |
110 | case 0x ## a: \ | |
111 | reg = PIPE ## a ## TRN; \ | |
112 | break; | |
113 | ||
114 | switch (num) { | |
115 | CASE_PIPExTRN(1); | |
116 | CASE_PIPExTRN(2); | |
117 | CASE_PIPExTRN(3); | |
118 | CASE_PIPExTRN(4); | |
119 | CASE_PIPExTRN(5); | |
120 | CASE_PIPExTRN(B); | |
121 | CASE_PIPExTRN(C); | |
122 | CASE_PIPExTRN(D); | |
123 | CASE_PIPExTRN(E); | |
124 | CASE_PIPExTRN(F); | |
125 | CASE_PIPExTRN(9); | |
126 | CASE_PIPExTRN(A); | |
127 | default: | |
128 | dev_err(dev, "unknown pipe (%d)\n", num); | |
129 | return; | |
130 | } | |
131 | __usbhsp_pipe_xxx_set(pipe, 0, reg, mask, val); | |
132 | } | |
133 | ||
134 | static void usbhsp_pipe_tre_set(struct usbhs_pipe *pipe, u16 mask, u16 val) | |
135 | { | |
136 | struct usbhs_priv *priv = usbhs_pipe_to_priv(pipe); | |
137 | struct device *dev = usbhs_priv_to_dev(priv); | |
138 | int num = usbhs_pipe_number(pipe); | |
139 | u16 reg; | |
140 | ||
141 | /* | |
142 | * It is impossible to calculate address, | |
143 | * since PIPEnTRE addresses were mapped randomly. | |
144 | */ | |
145 | #define CASE_PIPExTRE(a) \ | |
146 | case 0x ## a: \ | |
147 | reg = PIPE ## a ## TRE; \ | |
148 | break; | |
149 | ||
150 | switch (num) { | |
151 | CASE_PIPExTRE(1); | |
152 | CASE_PIPExTRE(2); | |
153 | CASE_PIPExTRE(3); | |
154 | CASE_PIPExTRE(4); | |
155 | CASE_PIPExTRE(5); | |
156 | CASE_PIPExTRE(B); | |
157 | CASE_PIPExTRE(C); | |
158 | CASE_PIPExTRE(D); | |
159 | CASE_PIPExTRE(E); | |
160 | CASE_PIPExTRE(F); | |
161 | CASE_PIPExTRE(9); | |
162 | CASE_PIPExTRE(A); | |
163 | default: | |
164 | dev_err(dev, "unknown pipe (%d)\n", num); | |
165 | return; | |
166 | } | |
167 | ||
168 | __usbhsp_pipe_xxx_set(pipe, 0, reg, mask, val); | |
169 | } | |
170 | ||
f1407d5c KM |
171 | /* |
172 | * PIPEBUF | |
173 | */ | |
174 | static void usbhsp_pipe_buf_set(struct usbhs_pipe *pipe, u16 mask, u16 val) | |
175 | { | |
e8d548d5 | 176 | if (usbhs_pipe_is_dcp(pipe)) |
f1407d5c KM |
177 | return; |
178 | ||
179 | __usbhsp_pipe_xxx_set(pipe, 0, PIPEBUF, mask, val); | |
180 | } | |
181 | ||
182 | /* | |
183 | * DCPMAXP/PIPEMAXP | |
184 | */ | |
185 | static void usbhsp_pipe_maxp_set(struct usbhs_pipe *pipe, u16 mask, u16 val) | |
186 | { | |
187 | __usbhsp_pipe_xxx_set(pipe, DCPMAXP, PIPEMAXP, mask, val); | |
188 | } | |
189 | ||
f1407d5c KM |
190 | /* |
191 | * pipe control functions | |
192 | */ | |
193 | static void usbhsp_pipe_select(struct usbhs_pipe *pipe) | |
194 | { | |
e8d548d5 | 195 | struct usbhs_priv *priv = usbhs_pipe_to_priv(pipe); |
f1407d5c KM |
196 | |
197 | /* | |
198 | * On pipe, this is necessary before | |
199 | * accesses to below registers. | |
200 | * | |
201 | * PIPESEL : usbhsp_pipe_select | |
202 | * PIPECFG : usbhsp_pipe_cfg_xxx | |
203 | * PIPEBUF : usbhsp_pipe_buf_xxx | |
204 | * PIPEMAXP : usbhsp_pipe_maxp_xxx | |
205 | * PIPEPERI | |
206 | */ | |
207 | ||
208 | /* | |
209 | * if pipe is dcp, no pipe is selected. | |
210 | * it is no problem, because dcp have its register | |
211 | */ | |
212 | usbhs_write(priv, PIPESEL, 0xF & usbhs_pipe_number(pipe)); | |
213 | } | |
214 | ||
215 | static int usbhsp_pipe_barrier(struct usbhs_pipe *pipe) | |
216 | { | |
e8d548d5 | 217 | struct usbhs_priv *priv = usbhs_pipe_to_priv(pipe); |
f1407d5c KM |
218 | int timeout = 1024; |
219 | u16 val; | |
220 | ||
221 | /* | |
222 | * make sure.... | |
223 | * | |
224 | * Modify these bits when CSSTS = 0, PID = NAK, and no pipe number is | |
225 | * specified by the CURPIPE bits. | |
226 | * When changing the setting of this bit after changing | |
227 | * the PID bits for the selected pipe from BUF to NAK, | |
228 | * check that CSSTS = 0 and PBUSY = 0. | |
229 | */ | |
230 | ||
231 | /* | |
232 | * CURPIPE bit = 0 | |
233 | * | |
234 | * see also | |
235 | * "Operation" | |
236 | * - "Pipe Control" | |
237 | * - "Pipe Control Registers Switching Procedure" | |
238 | */ | |
239 | usbhs_write(priv, CFIFOSEL, 0); | |
e8d548d5 | 240 | usbhs_pipe_disable(pipe); |
f1407d5c KM |
241 | |
242 | do { | |
243 | val = usbhsp_pipectrl_get(pipe); | |
244 | val &= CSSTS | PID_MASK; | |
245 | if (!val) | |
246 | return 0; | |
247 | ||
248 | udelay(10); | |
249 | ||
250 | } while (timeout--); | |
251 | ||
f1407d5c KM |
252 | return -EBUSY; |
253 | } | |
254 | ||
e8d548d5 | 255 | int usbhs_pipe_is_accessible(struct usbhs_pipe *pipe) |
f1407d5c KM |
256 | { |
257 | u16 val; | |
258 | ||
259 | val = usbhsp_pipectrl_get(pipe); | |
260 | if (val & BSTS) | |
261 | return 0; | |
262 | ||
263 | return -EBUSY; | |
264 | } | |
265 | ||
266 | /* | |
267 | * PID ctrl | |
268 | */ | |
269 | static void __usbhsp_pid_try_nak_if_stall(struct usbhs_pipe *pipe) | |
270 | { | |
271 | u16 pid = usbhsp_pipectrl_get(pipe); | |
272 | ||
273 | pid &= PID_MASK; | |
274 | ||
275 | /* | |
276 | * see | |
277 | * "Pipe n Control Register" - "PID" | |
278 | */ | |
279 | switch (pid) { | |
280 | case PID_STALL11: | |
281 | usbhsp_pipectrl_set(pipe, PID_MASK, PID_STALL10); | |
282 | /* fall-through */ | |
283 | case PID_STALL10: | |
284 | usbhsp_pipectrl_set(pipe, PID_MASK, PID_NAK); | |
285 | } | |
286 | } | |
287 | ||
e8d548d5 | 288 | void usbhs_pipe_disable(struct usbhs_pipe *pipe) |
f1407d5c | 289 | { |
c786e09c KM |
290 | int timeout = 1024; |
291 | u16 val; | |
292 | ||
f1407d5c KM |
293 | /* see "Pipe n Control Register" - "PID" */ |
294 | __usbhsp_pid_try_nak_if_stall(pipe); | |
295 | ||
296 | usbhsp_pipectrl_set(pipe, PID_MASK, PID_NAK); | |
c786e09c KM |
297 | |
298 | do { | |
299 | val = usbhsp_pipectrl_get(pipe); | |
300 | val &= PBUSY; | |
301 | if (!val) | |
302 | break; | |
303 | ||
304 | udelay(10); | |
305 | } while (timeout--); | |
f1407d5c KM |
306 | } |
307 | ||
e8d548d5 | 308 | void usbhs_pipe_enable(struct usbhs_pipe *pipe) |
f1407d5c KM |
309 | { |
310 | /* see "Pipe n Control Register" - "PID" */ | |
311 | __usbhsp_pid_try_nak_if_stall(pipe); | |
312 | ||
313 | usbhsp_pipectrl_set(pipe, PID_MASK, PID_BUF); | |
314 | } | |
315 | ||
e8d548d5 | 316 | void usbhs_pipe_stall(struct usbhs_pipe *pipe) |
f1407d5c KM |
317 | { |
318 | u16 pid = usbhsp_pipectrl_get(pipe); | |
319 | ||
320 | pid &= PID_MASK; | |
321 | ||
322 | /* | |
323 | * see | |
324 | * "Pipe n Control Register" - "PID" | |
325 | */ | |
326 | switch (pid) { | |
327 | case PID_NAK: | |
328 | usbhsp_pipectrl_set(pipe, PID_MASK, PID_STALL10); | |
329 | break; | |
330 | case PID_BUF: | |
331 | usbhsp_pipectrl_set(pipe, PID_MASK, PID_STALL11); | |
332 | break; | |
333 | } | |
334 | } | |
335 | ||
9cf1b06e KM |
336 | int usbhs_pipe_is_stall(struct usbhs_pipe *pipe) |
337 | { | |
338 | u16 pid = usbhsp_pipectrl_get(pipe) & PID_MASK; | |
339 | ||
340 | return (int)(pid == PID_STALL10 || pid == PID_STALL11); | |
341 | } | |
342 | ||
1c90ee0b KM |
343 | void usbhs_pipe_set_trans_count_if_bulk(struct usbhs_pipe *pipe, int len) |
344 | { | |
345 | if (!usbhs_pipe_type_is(pipe, USB_ENDPOINT_XFER_BULK)) | |
346 | return; | |
347 | ||
348 | /* | |
349 | * clear and disable transfer counter for IN/OUT pipe | |
350 | */ | |
351 | usbhsp_pipe_tre_set(pipe, TRCLR | TRENB, TRCLR); | |
352 | ||
353 | /* | |
354 | * Only IN direction bulk pipe can use transfer count. | |
355 | * Without using this function, | |
356 | * received data will break if it was large data size. | |
357 | * see PIPEnTRN/PIPEnTRE for detail | |
358 | */ | |
359 | if (usbhs_pipe_is_dir_in(pipe)) { | |
360 | int maxp = usbhs_pipe_get_maxpacket(pipe); | |
361 | ||
362 | usbhsp_pipe_trn_set(pipe, 0xffff, DIV_ROUND_UP(len, maxp)); | |
363 | usbhsp_pipe_tre_set(pipe, TRENB, TRENB); /* enable */ | |
364 | } | |
365 | } | |
366 | ||
367 | ||
f1407d5c KM |
368 | /* |
369 | * pipe setup | |
370 | */ | |
371 | static int usbhsp_possible_double_buffer(struct usbhs_pipe *pipe) | |
372 | { | |
373 | /* | |
374 | * only ISO / BULK pipe can use double buffer | |
375 | */ | |
356db7ed KM |
376 | if (usbhs_pipe_type_is(pipe, USB_ENDPOINT_XFER_BULK) || |
377 | usbhs_pipe_type_is(pipe, USB_ENDPOINT_XFER_ISOC)) | |
f1407d5c KM |
378 | return 1; |
379 | ||
380 | return 0; | |
381 | } | |
382 | ||
383 | static u16 usbhsp_setup_pipecfg(struct usbhs_pipe *pipe, | |
f5aa889f KM |
384 | int is_host, |
385 | int dir_in) | |
f1407d5c KM |
386 | { |
387 | u16 type = 0; | |
388 | u16 bfre = 0; | |
389 | u16 dblb = 0; | |
390 | u16 cntmd = 0; | |
391 | u16 dir = 0; | |
392 | u16 epnum = 0; | |
393 | u16 shtnak = 0; | |
394 | u16 type_array[] = { | |
395 | [USB_ENDPOINT_XFER_BULK] = TYPE_BULK, | |
396 | [USB_ENDPOINT_XFER_INT] = TYPE_INT, | |
397 | [USB_ENDPOINT_XFER_ISOC] = TYPE_ISO, | |
398 | }; | |
399 | int is_double = usbhsp_possible_double_buffer(pipe); | |
400 | ||
e8d548d5 | 401 | if (usbhs_pipe_is_dcp(pipe)) |
f1407d5c KM |
402 | return -EINVAL; |
403 | ||
404 | /* | |
405 | * PIPECFG | |
406 | * | |
407 | * see | |
408 | * - "Register Descriptions" - "PIPECFG" register | |
409 | * - "Features" - "Pipe configuration" | |
410 | * - "Operation" - "Pipe Control" | |
411 | */ | |
412 | ||
413 | /* TYPE */ | |
356db7ed | 414 | type = type_array[usbhs_pipe_type(pipe)]; |
f1407d5c KM |
415 | |
416 | /* BFRE */ | |
356db7ed KM |
417 | if (usbhs_pipe_type_is(pipe, USB_ENDPOINT_XFER_ISOC) || |
418 | usbhs_pipe_type_is(pipe, USB_ENDPOINT_XFER_BULK)) | |
f1407d5c KM |
419 | bfre = 0; /* FIXME */ |
420 | ||
421 | /* DBLB */ | |
356db7ed KM |
422 | if (usbhs_pipe_type_is(pipe, USB_ENDPOINT_XFER_ISOC) || |
423 | usbhs_pipe_type_is(pipe, USB_ENDPOINT_XFER_BULK)) | |
f1407d5c KM |
424 | dblb = (is_double) ? DBLB : 0; |
425 | ||
426 | /* CNTMD */ | |
356db7ed | 427 | if (usbhs_pipe_type_is(pipe, USB_ENDPOINT_XFER_BULK)) |
f1407d5c KM |
428 | cntmd = 0; /* FIXME */ |
429 | ||
430 | /* DIR */ | |
f5aa889f | 431 | if (dir_in) |
ad6f2a8b | 432 | usbhsp_flags_set(pipe, IS_DIR_HOST); |
f1407d5c | 433 | |
14ff96e0 | 434 | if (!!is_host ^ !!dir_in) |
f1407d5c KM |
435 | dir |= DIR_OUT; |
436 | ||
ad6f2a8b KM |
437 | if (!dir) |
438 | usbhsp_flags_set(pipe, IS_DIR_IN); | |
439 | ||
f1407d5c | 440 | /* SHTNAK */ |
356db7ed | 441 | if (usbhs_pipe_type_is(pipe, USB_ENDPOINT_XFER_BULK) && |
f1407d5c KM |
442 | !dir) |
443 | shtnak = SHTNAK; | |
444 | ||
445 | /* EPNUM */ | |
f5aa889f | 446 | epnum = 0; /* see usbhs_pipe_config_update() */ |
f1407d5c KM |
447 | |
448 | return type | | |
449 | bfre | | |
450 | dblb | | |
451 | cntmd | | |
452 | dir | | |
453 | shtnak | | |
454 | epnum; | |
455 | } | |
456 | ||
f5aa889f | 457 | static u16 usbhsp_setup_pipebuff(struct usbhs_pipe *pipe) |
f1407d5c | 458 | { |
e8d548d5 KM |
459 | struct usbhs_priv *priv = usbhs_pipe_to_priv(pipe); |
460 | struct usbhs_pipe_info *info = usbhs_priv_to_pipeinfo(priv); | |
f1407d5c KM |
461 | struct device *dev = usbhs_priv_to_dev(priv); |
462 | int pipe_num = usbhs_pipe_number(pipe); | |
463 | int is_double = usbhsp_possible_double_buffer(pipe); | |
464 | u16 buff_size; | |
465 | u16 bufnmb; | |
466 | u16 bufnmb_cnt; | |
467 | ||
468 | /* | |
469 | * PIPEBUF | |
470 | * | |
471 | * see | |
472 | * - "Register Descriptions" - "PIPEBUF" register | |
473 | * - "Features" - "Pipe configuration" | |
474 | * - "Operation" - "FIFO Buffer Memory" | |
475 | * - "Operation" - "Pipe Control" | |
476 | * | |
477 | * ex) if pipe6 - pipe9 are USB_ENDPOINT_XFER_INT (SH7724) | |
478 | * | |
479 | * BUFNMB: PIPE | |
480 | * 0: pipe0 (DCP 256byte) | |
481 | * 1: - | |
482 | * 2: - | |
483 | * 3: - | |
484 | * 4: pipe6 (INT 64byte) | |
485 | * 5: pipe7 (INT 64byte) | |
486 | * 6: pipe8 (INT 64byte) | |
487 | * 7: pipe9 (INT 64byte) | |
488 | * 8 - xx: free (for BULK, ISOC) | |
489 | */ | |
490 | ||
491 | /* | |
492 | * FIXME | |
493 | * | |
494 | * it doesn't have good buffer allocator | |
495 | * | |
496 | * DCP : 256 byte | |
497 | * BULK: 512 byte | |
498 | * INT : 64 byte | |
499 | * ISOC: 512 byte | |
500 | */ | |
356db7ed | 501 | if (usbhs_pipe_type_is(pipe, USB_ENDPOINT_XFER_CONTROL)) |
f1407d5c | 502 | buff_size = 256; |
356db7ed | 503 | else if (usbhs_pipe_type_is(pipe, USB_ENDPOINT_XFER_INT)) |
f1407d5c KM |
504 | buff_size = 64; |
505 | else | |
506 | buff_size = 512; | |
507 | ||
508 | /* change buff_size to register value */ | |
509 | bufnmb_cnt = (buff_size / 64) - 1; | |
510 | ||
511 | /* BUFNMB has been reserved for INT pipe | |
512 | * see above */ | |
356db7ed | 513 | if (usbhs_pipe_type_is(pipe, USB_ENDPOINT_XFER_INT)) { |
f1407d5c KM |
514 | bufnmb = pipe_num - 2; |
515 | } else { | |
516 | bufnmb = info->bufnmb_last; | |
517 | info->bufnmb_last += bufnmb_cnt + 1; | |
518 | ||
519 | /* | |
520 | * double buffer | |
521 | */ | |
522 | if (is_double) | |
523 | info->bufnmb_last += bufnmb_cnt + 1; | |
524 | } | |
525 | ||
526 | dev_dbg(dev, "pipe : %d : buff_size 0x%x: bufnmb 0x%x\n", | |
527 | pipe_num, buff_size, bufnmb); | |
528 | ||
529 | return (0x1f & bufnmb_cnt) << 10 | | |
530 | (0xff & bufnmb) << 0; | |
531 | } | |
532 | ||
bc6fbf59 KM |
533 | void usbhs_pipe_config_update(struct usbhs_pipe *pipe, u16 devsel, |
534 | u16 epnum, u16 maxp) | |
f5aa889f | 535 | { |
bc6fbf59 KM |
536 | if (devsel > 0xA) { |
537 | struct usbhs_priv *priv = usbhs_pipe_to_priv(pipe); | |
538 | struct device *dev = usbhs_priv_to_dev(priv); | |
539 | ||
540 | dev_err(dev, "devsel error %d\n", devsel); | |
541 | ||
542 | devsel = 0; | |
543 | } | |
544 | ||
f5aa889f KM |
545 | usbhsp_pipe_barrier(pipe); |
546 | ||
7fd097e7 KM |
547 | pipe->maxp = maxp; |
548 | ||
f5aa889f | 549 | usbhsp_pipe_select(pipe); |
bc6fbf59 KM |
550 | usbhsp_pipe_maxp_set(pipe, 0xFFFF, |
551 | (devsel << 12) | | |
552 | maxp); | |
f5aa889f KM |
553 | |
554 | if (!usbhs_pipe_is_dcp(pipe)) | |
555 | usbhsp_pipe_cfg_set(pipe, 0x000F, epnum); | |
556 | } | |
557 | ||
f1407d5c KM |
558 | /* |
559 | * pipe control | |
560 | */ | |
561 | int usbhs_pipe_get_maxpacket(struct usbhs_pipe *pipe) | |
562 | { | |
7fd097e7 KM |
563 | /* |
564 | * see | |
565 | * usbhs_pipe_config_update() | |
566 | * usbhs_dcp_malloc() | |
567 | */ | |
568 | return pipe->maxp; | |
f1407d5c KM |
569 | } |
570 | ||
571 | int usbhs_pipe_is_dir_in(struct usbhs_pipe *pipe) | |
572 | { | |
573 | return usbhsp_flags_has(pipe, IS_DIR_IN); | |
574 | } | |
575 | ||
ad6f2a8b KM |
576 | int usbhs_pipe_is_dir_host(struct usbhs_pipe *pipe) |
577 | { | |
578 | return usbhsp_flags_has(pipe, IS_DIR_HOST); | |
579 | } | |
580 | ||
58e47d43 YS |
581 | int usbhs_pipe_is_running(struct usbhs_pipe *pipe) |
582 | { | |
583 | return usbhsp_flags_has(pipe, IS_RUNNING); | |
584 | } | |
585 | ||
586 | void usbhs_pipe_running(struct usbhs_pipe *pipe, int running) | |
587 | { | |
588 | if (running) | |
589 | usbhsp_flags_set(pipe, IS_RUNNING); | |
590 | else | |
591 | usbhsp_flags_clr(pipe, IS_RUNNING); | |
592 | } | |
593 | ||
3edeee38 | 594 | void usbhs_pipe_data_sequence(struct usbhs_pipe *pipe, int sequence) |
f1407d5c | 595 | { |
6e6db82b | 596 | u16 mask = (SQCLR | SQSET); |
3edeee38 KM |
597 | u16 val; |
598 | ||
599 | /* | |
600 | * sequence | |
601 | * 0 : data0 | |
602 | * 1 : data1 | |
603 | * -1 : no change | |
604 | */ | |
605 | switch (sequence) { | |
606 | case 0: | |
607 | val = SQCLR; | |
608 | break; | |
609 | case 1: | |
610 | val = SQSET; | |
611 | break; | |
612 | default: | |
613 | return; | |
614 | } | |
6e6db82b KM |
615 | |
616 | usbhsp_pipectrl_set(pipe, mask, val); | |
f1407d5c KM |
617 | } |
618 | ||
08e6c611 KM |
619 | void usbhs_pipe_clear(struct usbhs_pipe *pipe) |
620 | { | |
621 | usbhsp_pipectrl_set(pipe, ACLRM, ACLRM); | |
622 | usbhsp_pipectrl_set(pipe, ACLRM, 0); | |
623 | } | |
624 | ||
f1407d5c KM |
625 | static struct usbhs_pipe *usbhsp_get_pipe(struct usbhs_priv *priv, u32 type) |
626 | { | |
627 | struct usbhs_pipe *pos, *pipe; | |
628 | int i; | |
629 | ||
630 | /* | |
631 | * find target pipe | |
632 | */ | |
633 | pipe = NULL; | |
634 | usbhs_for_each_pipe_with_dcp(pos, priv, i) { | |
356db7ed | 635 | if (!usbhs_pipe_type_is(pos, type)) |
f1407d5c KM |
636 | continue; |
637 | if (usbhsp_flags_has(pos, IS_USED)) | |
638 | continue; | |
639 | ||
640 | pipe = pos; | |
641 | break; | |
642 | } | |
643 | ||
644 | if (!pipe) | |
645 | return NULL; | |
646 | ||
647 | /* | |
648 | * initialize pipe flags | |
649 | */ | |
650 | usbhsp_flags_init(pipe); | |
651 | usbhsp_flags_set(pipe, IS_USED); | |
652 | ||
653 | return pipe; | |
654 | } | |
655 | ||
4bd04811 | 656 | void usbhs_pipe_init(struct usbhs_priv *priv, |
e73a9891 | 657 | int (*dma_map_ctrl)(struct usbhs_pkt *pkt, int map)) |
f1407d5c | 658 | { |
e8d548d5 | 659 | struct usbhs_pipe_info *info = usbhs_priv_to_pipeinfo(priv); |
f1407d5c KM |
660 | struct usbhs_pipe *pipe; |
661 | int i; | |
662 | ||
663 | /* | |
664 | * FIXME | |
665 | * | |
666 | * driver needs good allocator. | |
667 | * | |
668 | * find first free buffer area (BULK, ISOC) | |
669 | * (DCP, INT area is fixed) | |
670 | * | |
671 | * buffer number 0 - 3 have been reserved for DCP | |
672 | * see | |
673 | * usbhsp_to_bufnmb | |
674 | */ | |
675 | info->bufnmb_last = 4; | |
676 | usbhs_for_each_pipe_with_dcp(pipe, priv, i) { | |
356db7ed | 677 | if (usbhs_pipe_type_is(pipe, USB_ENDPOINT_XFER_INT)) |
f1407d5c KM |
678 | info->bufnmb_last++; |
679 | ||
680 | usbhsp_flags_init(pipe); | |
d77e3f4e | 681 | pipe->fifo = NULL; |
f1407d5c | 682 | pipe->mod_private = NULL; |
6acb95d4 | 683 | INIT_LIST_HEAD(&pipe->list); |
45e13e6e | 684 | |
e8d548d5 | 685 | /* pipe force init */ |
08e6c611 | 686 | usbhs_pipe_clear(pipe); |
f1407d5c | 687 | } |
4bd04811 | 688 | |
e73a9891 | 689 | info->dma_map_ctrl = dma_map_ctrl; |
f1407d5c KM |
690 | } |
691 | ||
692 | struct usbhs_pipe *usbhs_pipe_malloc(struct usbhs_priv *priv, | |
f5aa889f KM |
693 | int endpoint_type, |
694 | int dir_in) | |
f1407d5c KM |
695 | { |
696 | struct device *dev = usbhs_priv_to_dev(priv); | |
f1407d5c | 697 | struct usbhs_pipe *pipe; |
0deb3e77 | 698 | int is_host = usbhs_mod_is_host(priv); |
f1407d5c | 699 | int ret; |
f5aa889f | 700 | u16 pipecfg, pipebuf; |
f1407d5c | 701 | |
f5aa889f | 702 | pipe = usbhsp_get_pipe(priv, endpoint_type); |
f429ea3f KM |
703 | if (!pipe) { |
704 | dev_err(dev, "can't get pipe (%s)\n", | |
f5aa889f | 705 | usbhsp_pipe_name[endpoint_type]); |
f1407d5c | 706 | return NULL; |
f429ea3f | 707 | } |
f1407d5c | 708 | |
6acb95d4 KM |
709 | INIT_LIST_HEAD(&pipe->list); |
710 | ||
e8d548d5 | 711 | usbhs_pipe_disable(pipe); |
f1407d5c KM |
712 | |
713 | /* make sure pipe is not busy */ | |
714 | ret = usbhsp_pipe_barrier(pipe); | |
715 | if (ret < 0) { | |
716 | dev_err(dev, "pipe setup failed %d\n", usbhs_pipe_number(pipe)); | |
717 | return NULL; | |
718 | } | |
719 | ||
f5aa889f KM |
720 | pipecfg = usbhsp_setup_pipecfg(pipe, is_host, dir_in); |
721 | pipebuf = usbhsp_setup_pipebuff(pipe); | |
f1407d5c | 722 | |
f1407d5c KM |
723 | usbhsp_pipe_select(pipe); |
724 | usbhsp_pipe_cfg_set(pipe, 0xFFFF, pipecfg); | |
725 | usbhsp_pipe_buf_set(pipe, 0xFFFF, pipebuf); | |
f1407d5c | 726 | |
6e6db82b | 727 | usbhs_pipe_sequence_data0(pipe); |
f1407d5c KM |
728 | |
729 | dev_dbg(dev, "enable pipe %d : %s (%s)\n", | |
730 | usbhs_pipe_number(pipe), | |
3cf8ed12 | 731 | usbhs_pipe_name(pipe), |
f1407d5c KM |
732 | usbhs_pipe_is_dir_in(pipe) ? "in" : "out"); |
733 | ||
f5aa889f KM |
734 | /* |
735 | * epnum / maxp are still not set to this pipe. | |
736 | * call usbhs_pipe_config_update() after this function !! | |
737 | */ | |
738 | ||
f1407d5c KM |
739 | return pipe; |
740 | } | |
741 | ||
d77e3f4e KM |
742 | void usbhs_pipe_select_fifo(struct usbhs_pipe *pipe, struct usbhs_fifo *fifo) |
743 | { | |
744 | if (pipe->fifo) | |
745 | pipe->fifo->pipe = NULL; | |
746 | ||
747 | pipe->fifo = fifo; | |
748 | ||
749 | if (fifo) | |
750 | fifo->pipe = pipe; | |
751 | } | |
752 | ||
753 | ||
f1407d5c KM |
754 | /* |
755 | * dcp control | |
756 | */ | |
757 | struct usbhs_pipe *usbhs_dcp_malloc(struct usbhs_priv *priv) | |
758 | { | |
759 | struct usbhs_pipe *pipe; | |
760 | ||
761 | pipe = usbhsp_get_pipe(priv, USB_ENDPOINT_XFER_CONTROL); | |
762 | if (!pipe) | |
763 | return NULL; | |
764 | ||
f5aa889f KM |
765 | INIT_LIST_HEAD(&pipe->list); |
766 | ||
f1407d5c | 767 | /* |
f5aa889f | 768 | * call usbhs_pipe_config_update() after this function !! |
f1407d5c KM |
769 | */ |
770 | ||
f1407d5c KM |
771 | return pipe; |
772 | } | |
773 | ||
774 | void usbhs_dcp_control_transfer_done(struct usbhs_pipe *pipe) | |
775 | { | |
e2eddc61 KM |
776 | struct usbhs_priv *priv = usbhs_pipe_to_priv(pipe); |
777 | ||
e8d548d5 | 778 | WARN_ON(!usbhs_pipe_is_dcp(pipe)); |
f1407d5c | 779 | |
e8d548d5 | 780 | usbhs_pipe_enable(pipe); |
e2eddc61 KM |
781 | |
782 | if (!usbhs_mod_is_host(priv)) /* funconly */ | |
783 | usbhsp_pipectrl_set(pipe, CCPL, CCPL); | |
f1407d5c KM |
784 | } |
785 | ||
92352071 KM |
786 | void usbhs_dcp_dir_for_host(struct usbhs_pipe *pipe, int dir_out) |
787 | { | |
788 | usbhsp_pipe_cfg_set(pipe, DIR_OUT, | |
789 | dir_out ? DIR_OUT : 0); | |
790 | } | |
791 | ||
f1407d5c KM |
792 | /* |
793 | * pipe module function | |
794 | */ | |
795 | int usbhs_pipe_probe(struct usbhs_priv *priv) | |
796 | { | |
e8d548d5 | 797 | struct usbhs_pipe_info *info = usbhs_priv_to_pipeinfo(priv); |
f1407d5c KM |
798 | struct usbhs_pipe *pipe; |
799 | struct device *dev = usbhs_priv_to_dev(priv); | |
800 | u32 *pipe_type = usbhs_get_dparam(priv, pipe_type); | |
801 | int pipe_size = usbhs_get_dparam(priv, pipe_size); | |
802 | int i; | |
803 | ||
804 | /* This driver expects 1st pipe is DCP */ | |
805 | if (pipe_type[0] != USB_ENDPOINT_XFER_CONTROL) { | |
806 | dev_err(dev, "1st PIPE is not DCP\n"); | |
807 | return -EINVAL; | |
808 | } | |
809 | ||
810 | info->pipe = kzalloc(sizeof(struct usbhs_pipe) * pipe_size, GFP_KERNEL); | |
811 | if (!info->pipe) { | |
812 | dev_err(dev, "Could not allocate pipe\n"); | |
813 | return -ENOMEM; | |
814 | } | |
815 | ||
816 | info->size = pipe_size; | |
817 | ||
818 | /* | |
819 | * init pipe | |
820 | */ | |
821 | usbhs_for_each_pipe_with_dcp(pipe, priv, i) { | |
822 | pipe->priv = priv; | |
356db7ed KM |
823 | |
824 | usbhs_pipe_type(pipe) = | |
825 | pipe_type[i] & USB_ENDPOINT_XFERTYPE_MASK; | |
f1407d5c KM |
826 | |
827 | dev_dbg(dev, "pipe %x\t: %s\n", | |
828 | i, usbhsp_pipe_name[pipe_type[i]]); | |
829 | } | |
830 | ||
831 | return 0; | |
832 | } | |
833 | ||
834 | void usbhs_pipe_remove(struct usbhs_priv *priv) | |
835 | { | |
e8d548d5 | 836 | struct usbhs_pipe_info *info = usbhs_priv_to_pipeinfo(priv); |
f1407d5c KM |
837 | |
838 | kfree(info->pipe); | |
839 | } |