Loading...
1/*
2 * hcd_ddma.c - DesignWare HS OTG Controller descriptor DMA routines
3 *
4 * Copyright (C) 2004-2013 Synopsys, Inc.
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
8 * are met:
9 * 1. Redistributions of source code must retain the above copyright
10 * notice, this list of conditions, and the following disclaimer,
11 * without modification.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 * 3. The names of the above-listed copyright holders may not be used
16 * to endorse or promote products derived from this software without
17 * specific prior written permission.
18 *
19 * ALTERNATIVELY, this software may be distributed under the terms of the
20 * GNU General Public License ("GPL") as published by the Free Software
21 * Foundation; either version 2 of the License, or (at your option) any
22 * later version.
23 *
24 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS
25 * IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
26 * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
27 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
28 * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
29 * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
30 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
31 * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
32 * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
33 * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
34 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
35 */
36
37/*
38 * This file contains the Descriptor DMA implementation for Host mode
39 */
40#include <linux/kernel.h>
41#include <linux/module.h>
42#include <linux/spinlock.h>
43#include <linux/interrupt.h>
44#include <linux/dma-mapping.h>
45#include <linux/io.h>
46#include <linux/slab.h>
47#include <linux/usb.h>
48
49#include <linux/usb/hcd.h>
50#include <linux/usb/ch11.h>
51
52#include "core.h"
53#include "hcd.h"
54
55static u16 dwc2_frame_list_idx(u16 frame)
56{
57 return frame & (FRLISTEN_64_SIZE - 1);
58}
59
60static u16 dwc2_desclist_idx_inc(u16 idx, u16 inc, u8 speed)
61{
62 return (idx + inc) &
63 ((speed == USB_SPEED_HIGH ? MAX_DMA_DESC_NUM_HS_ISOC :
64 MAX_DMA_DESC_NUM_GENERIC) - 1);
65}
66
67static u16 dwc2_desclist_idx_dec(u16 idx, u16 inc, u8 speed)
68{
69 return (idx - inc) &
70 ((speed == USB_SPEED_HIGH ? MAX_DMA_DESC_NUM_HS_ISOC :
71 MAX_DMA_DESC_NUM_GENERIC) - 1);
72}
73
74static u16 dwc2_max_desc_num(struct dwc2_qh *qh)
75{
76 return (qh->ep_type == USB_ENDPOINT_XFER_ISOC &&
77 qh->dev_speed == USB_SPEED_HIGH) ?
78 MAX_DMA_DESC_NUM_HS_ISOC : MAX_DMA_DESC_NUM_GENERIC;
79}
80
81static u16 dwc2_frame_incr_val(struct dwc2_qh *qh)
82{
83 return qh->dev_speed == USB_SPEED_HIGH ?
84 (qh->host_interval + 8 - 1) / 8 : qh->host_interval;
85}
86
87static int dwc2_desc_list_alloc(struct dwc2_hsotg *hsotg, struct dwc2_qh *qh,
88 gfp_t flags)
89{
90 struct kmem_cache *desc_cache;
91
92 if (qh->ep_type == USB_ENDPOINT_XFER_ISOC
93 && qh->dev_speed == USB_SPEED_HIGH)
94 desc_cache = hsotg->desc_hsisoc_cache;
95 else
96 desc_cache = hsotg->desc_gen_cache;
97
98 qh->desc_list_sz = sizeof(struct dwc2_hcd_dma_desc) *
99 dwc2_max_desc_num(qh);
100
101 qh->desc_list = kmem_cache_zalloc(desc_cache, flags | GFP_DMA);
102 if (!qh->desc_list)
103 return -ENOMEM;
104
105 qh->desc_list_dma = dma_map_single(hsotg->dev, qh->desc_list,
106 qh->desc_list_sz,
107 DMA_TO_DEVICE);
108
109 qh->n_bytes = kzalloc(sizeof(u32) * dwc2_max_desc_num(qh), flags);
110 if (!qh->n_bytes) {
111 dma_unmap_single(hsotg->dev, qh->desc_list_dma,
112 qh->desc_list_sz,
113 DMA_FROM_DEVICE);
114 kmem_cache_free(desc_cache, qh->desc_list);
115 qh->desc_list = NULL;
116 return -ENOMEM;
117 }
118
119 return 0;
120}
121
122static void dwc2_desc_list_free(struct dwc2_hsotg *hsotg, struct dwc2_qh *qh)
123{
124 struct kmem_cache *desc_cache;
125
126 if (qh->ep_type == USB_ENDPOINT_XFER_ISOC
127 && qh->dev_speed == USB_SPEED_HIGH)
128 desc_cache = hsotg->desc_hsisoc_cache;
129 else
130 desc_cache = hsotg->desc_gen_cache;
131
132 if (qh->desc_list) {
133 dma_unmap_single(hsotg->dev, qh->desc_list_dma,
134 qh->desc_list_sz, DMA_FROM_DEVICE);
135 kmem_cache_free(desc_cache, qh->desc_list);
136 qh->desc_list = NULL;
137 }
138
139 kfree(qh->n_bytes);
140 qh->n_bytes = NULL;
141}
142
143static int dwc2_frame_list_alloc(struct dwc2_hsotg *hsotg, gfp_t mem_flags)
144{
145 if (hsotg->frame_list)
146 return 0;
147
148 hsotg->frame_list_sz = 4 * FRLISTEN_64_SIZE;
149 hsotg->frame_list = kzalloc(hsotg->frame_list_sz, GFP_ATOMIC | GFP_DMA);
150 if (!hsotg->frame_list)
151 return -ENOMEM;
152
153 hsotg->frame_list_dma = dma_map_single(hsotg->dev, hsotg->frame_list,
154 hsotg->frame_list_sz,
155 DMA_TO_DEVICE);
156
157 return 0;
158}
159
160static void dwc2_frame_list_free(struct dwc2_hsotg *hsotg)
161{
162 unsigned long flags;
163
164 spin_lock_irqsave(&hsotg->lock, flags);
165
166 if (!hsotg->frame_list) {
167 spin_unlock_irqrestore(&hsotg->lock, flags);
168 return;
169 }
170
171 dma_unmap_single(hsotg->dev, hsotg->frame_list_dma,
172 hsotg->frame_list_sz, DMA_FROM_DEVICE);
173
174 kfree(hsotg->frame_list);
175 hsotg->frame_list = NULL;
176
177 spin_unlock_irqrestore(&hsotg->lock, flags);
178
179}
180
181static void dwc2_per_sched_enable(struct dwc2_hsotg *hsotg, u32 fr_list_en)
182{
183 u32 hcfg;
184 unsigned long flags;
185
186 spin_lock_irqsave(&hsotg->lock, flags);
187
188 hcfg = dwc2_readl(hsotg->regs + HCFG);
189 if (hcfg & HCFG_PERSCHEDENA) {
190 /* already enabled */
191 spin_unlock_irqrestore(&hsotg->lock, flags);
192 return;
193 }
194
195 dwc2_writel(hsotg->frame_list_dma, hsotg->regs + HFLBADDR);
196
197 hcfg &= ~HCFG_FRLISTEN_MASK;
198 hcfg |= fr_list_en | HCFG_PERSCHEDENA;
199 dev_vdbg(hsotg->dev, "Enabling Periodic schedule\n");
200 dwc2_writel(hcfg, hsotg->regs + HCFG);
201
202 spin_unlock_irqrestore(&hsotg->lock, flags);
203}
204
205static void dwc2_per_sched_disable(struct dwc2_hsotg *hsotg)
206{
207 u32 hcfg;
208 unsigned long flags;
209
210 spin_lock_irqsave(&hsotg->lock, flags);
211
212 hcfg = dwc2_readl(hsotg->regs + HCFG);
213 if (!(hcfg & HCFG_PERSCHEDENA)) {
214 /* already disabled */
215 spin_unlock_irqrestore(&hsotg->lock, flags);
216 return;
217 }
218
219 hcfg &= ~HCFG_PERSCHEDENA;
220 dev_vdbg(hsotg->dev, "Disabling Periodic schedule\n");
221 dwc2_writel(hcfg, hsotg->regs + HCFG);
222
223 spin_unlock_irqrestore(&hsotg->lock, flags);
224}
225
226/*
227 * Activates/Deactivates FrameList entries for the channel based on endpoint
228 * servicing period
229 */
230static void dwc2_update_frame_list(struct dwc2_hsotg *hsotg, struct dwc2_qh *qh,
231 int enable)
232{
233 struct dwc2_host_chan *chan;
234 u16 i, j, inc;
235
236 if (!hsotg) {
237 pr_err("hsotg = %p\n", hsotg);
238 return;
239 }
240
241 if (!qh->channel) {
242 dev_err(hsotg->dev, "qh->channel = %p\n", qh->channel);
243 return;
244 }
245
246 if (!hsotg->frame_list) {
247 dev_err(hsotg->dev, "hsotg->frame_list = %p\n",
248 hsotg->frame_list);
249 return;
250 }
251
252 chan = qh->channel;
253 inc = dwc2_frame_incr_val(qh);
254 if (qh->ep_type == USB_ENDPOINT_XFER_ISOC)
255 i = dwc2_frame_list_idx(qh->next_active_frame);
256 else
257 i = 0;
258
259 j = i;
260 do {
261 if (enable)
262 hsotg->frame_list[j] |= 1 << chan->hc_num;
263 else
264 hsotg->frame_list[j] &= ~(1 << chan->hc_num);
265 j = (j + inc) & (FRLISTEN_64_SIZE - 1);
266 } while (j != i);
267
268 /*
269 * Sync frame list since controller will access it if periodic
270 * channel is currently enabled.
271 */
272 dma_sync_single_for_device(hsotg->dev,
273 hsotg->frame_list_dma,
274 hsotg->frame_list_sz,
275 DMA_TO_DEVICE);
276
277 if (!enable)
278 return;
279
280 chan->schinfo = 0;
281 if (chan->speed == USB_SPEED_HIGH && qh->host_interval) {
282 j = 1;
283 /* TODO - check this */
284 inc = (8 + qh->host_interval - 1) / qh->host_interval;
285 for (i = 0; i < inc; i++) {
286 chan->schinfo |= j;
287 j = j << qh->host_interval;
288 }
289 } else {
290 chan->schinfo = 0xff;
291 }
292}
293
294static void dwc2_release_channel_ddma(struct dwc2_hsotg *hsotg,
295 struct dwc2_qh *qh)
296{
297 struct dwc2_host_chan *chan = qh->channel;
298
299 if (dwc2_qh_is_non_per(qh)) {
300 if (hsotg->core_params->uframe_sched > 0)
301 hsotg->available_host_channels++;
302 else
303 hsotg->non_periodic_channels--;
304 } else {
305 dwc2_update_frame_list(hsotg, qh, 0);
306 hsotg->available_host_channels++;
307 }
308
309 /*
310 * The condition is added to prevent double cleanup try in case of
311 * device disconnect. See channel cleanup in dwc2_hcd_disconnect().
312 */
313 if (chan->qh) {
314 if (!list_empty(&chan->hc_list_entry))
315 list_del(&chan->hc_list_entry);
316 dwc2_hc_cleanup(hsotg, chan);
317 list_add_tail(&chan->hc_list_entry, &hsotg->free_hc_list);
318 chan->qh = NULL;
319 }
320
321 qh->channel = NULL;
322 qh->ntd = 0;
323
324 if (qh->desc_list)
325 memset(qh->desc_list, 0, sizeof(struct dwc2_hcd_dma_desc) *
326 dwc2_max_desc_num(qh));
327}
328
329/**
330 * dwc2_hcd_qh_init_ddma() - Initializes a QH structure's Descriptor DMA
331 * related members
332 *
333 * @hsotg: The HCD state structure for the DWC OTG controller
334 * @qh: The QH to init
335 *
336 * Return: 0 if successful, negative error code otherwise
337 *
338 * Allocates memory for the descriptor list. For the first periodic QH,
339 * allocates memory for the FrameList and enables periodic scheduling.
340 */
341int dwc2_hcd_qh_init_ddma(struct dwc2_hsotg *hsotg, struct dwc2_qh *qh,
342 gfp_t mem_flags)
343{
344 int retval;
345
346 if (qh->do_split) {
347 dev_err(hsotg->dev,
348 "SPLIT Transfers are not supported in Descriptor DMA mode.\n");
349 retval = -EINVAL;
350 goto err0;
351 }
352
353 retval = dwc2_desc_list_alloc(hsotg, qh, mem_flags);
354 if (retval)
355 goto err0;
356
357 if (qh->ep_type == USB_ENDPOINT_XFER_ISOC ||
358 qh->ep_type == USB_ENDPOINT_XFER_INT) {
359 if (!hsotg->frame_list) {
360 retval = dwc2_frame_list_alloc(hsotg, mem_flags);
361 if (retval)
362 goto err1;
363 /* Enable periodic schedule on first periodic QH */
364 dwc2_per_sched_enable(hsotg, HCFG_FRLISTEN_64);
365 }
366 }
367
368 qh->ntd = 0;
369 return 0;
370
371err1:
372 dwc2_desc_list_free(hsotg, qh);
373err0:
374 return retval;
375}
376
377/**
378 * dwc2_hcd_qh_free_ddma() - Frees a QH structure's Descriptor DMA related
379 * members
380 *
381 * @hsotg: The HCD state structure for the DWC OTG controller
382 * @qh: The QH to free
383 *
384 * Frees descriptor list memory associated with the QH. If QH is periodic and
385 * the last, frees FrameList memory and disables periodic scheduling.
386 */
387void dwc2_hcd_qh_free_ddma(struct dwc2_hsotg *hsotg, struct dwc2_qh *qh)
388{
389 unsigned long flags;
390
391 dwc2_desc_list_free(hsotg, qh);
392
393 /*
394 * Channel still assigned due to some reasons.
395 * Seen on Isoc URB dequeue. Channel halted but no subsequent
396 * ChHalted interrupt to release the channel. Afterwards
397 * when it comes here from endpoint disable routine
398 * channel remains assigned.
399 */
400 spin_lock_irqsave(&hsotg->lock, flags);
401 if (qh->channel)
402 dwc2_release_channel_ddma(hsotg, qh);
403 spin_unlock_irqrestore(&hsotg->lock, flags);
404
405 if ((qh->ep_type == USB_ENDPOINT_XFER_ISOC ||
406 qh->ep_type == USB_ENDPOINT_XFER_INT) &&
407 (hsotg->core_params->uframe_sched > 0 ||
408 !hsotg->periodic_channels) && hsotg->frame_list) {
409 dwc2_per_sched_disable(hsotg);
410 dwc2_frame_list_free(hsotg);
411 }
412}
413
414static u8 dwc2_frame_to_desc_idx(struct dwc2_qh *qh, u16 frame_idx)
415{
416 if (qh->dev_speed == USB_SPEED_HIGH)
417 /* Descriptor set (8 descriptors) index which is 8-aligned */
418 return (frame_idx & ((MAX_DMA_DESC_NUM_HS_ISOC / 8) - 1)) * 8;
419 else
420 return frame_idx & (MAX_DMA_DESC_NUM_GENERIC - 1);
421}
422
423/*
424 * Determine starting frame for Isochronous transfer.
425 * Few frames skipped to prevent race condition with HC.
426 */
427static u16 dwc2_calc_starting_frame(struct dwc2_hsotg *hsotg,
428 struct dwc2_qh *qh, u16 *skip_frames)
429{
430 u16 frame;
431
432 hsotg->frame_number = dwc2_hcd_get_frame_number(hsotg);
433
434 /*
435 * next_active_frame is always frame number (not uFrame) both in FS
436 * and HS!
437 */
438
439 /*
440 * skip_frames is used to limit activated descriptors number
441 * to avoid the situation when HC services the last activated
442 * descriptor firstly.
443 * Example for FS:
444 * Current frame is 1, scheduled frame is 3. Since HC always fetches
445 * the descriptor corresponding to curr_frame+1, the descriptor
446 * corresponding to frame 2 will be fetched. If the number of
447 * descriptors is max=64 (or greather) the list will be fully programmed
448 * with Active descriptors and it is possible case (rare) that the
449 * latest descriptor(considering rollback) corresponding to frame 2 will
450 * be serviced first. HS case is more probable because, in fact, up to
451 * 11 uframes (16 in the code) may be skipped.
452 */
453 if (qh->dev_speed == USB_SPEED_HIGH) {
454 /*
455 * Consider uframe counter also, to start xfer asap. If half of
456 * the frame elapsed skip 2 frames otherwise just 1 frame.
457 * Starting descriptor index must be 8-aligned, so if the
458 * current frame is near to complete the next one is skipped as
459 * well.
460 */
461 if (dwc2_micro_frame_num(hsotg->frame_number) >= 5) {
462 *skip_frames = 2 * 8;
463 frame = dwc2_frame_num_inc(hsotg->frame_number,
464 *skip_frames);
465 } else {
466 *skip_frames = 1 * 8;
467 frame = dwc2_frame_num_inc(hsotg->frame_number,
468 *skip_frames);
469 }
470
471 frame = dwc2_full_frame_num(frame);
472 } else {
473 /*
474 * Two frames are skipped for FS - the current and the next.
475 * But for descriptor programming, 1 frame (descriptor) is
476 * enough, see example above.
477 */
478 *skip_frames = 1;
479 frame = dwc2_frame_num_inc(hsotg->frame_number, 2);
480 }
481
482 return frame;
483}
484
485/*
486 * Calculate initial descriptor index for isochronous transfer based on
487 * scheduled frame
488 */
489static u16 dwc2_recalc_initial_desc_idx(struct dwc2_hsotg *hsotg,
490 struct dwc2_qh *qh)
491{
492 u16 frame, fr_idx, fr_idx_tmp, skip_frames;
493
494 /*
495 * With current ISOC processing algorithm the channel is being released
496 * when no more QTDs in the list (qh->ntd == 0). Thus this function is
497 * called only when qh->ntd == 0 and qh->channel == 0.
498 *
499 * So qh->channel != NULL branch is not used and just not removed from
500 * the source file. It is required for another possible approach which
501 * is, do not disable and release the channel when ISOC session
502 * completed, just move QH to inactive schedule until new QTD arrives.
503 * On new QTD, the QH moved back to 'ready' schedule, starting frame and
504 * therefore starting desc_index are recalculated. In this case channel
505 * is released only on ep_disable.
506 */
507
508 /*
509 * Calculate starting descriptor index. For INTERRUPT endpoint it is
510 * always 0.
511 */
512 if (qh->channel) {
513 frame = dwc2_calc_starting_frame(hsotg, qh, &skip_frames);
514 /*
515 * Calculate initial descriptor index based on FrameList current
516 * bitmap and servicing period
517 */
518 fr_idx_tmp = dwc2_frame_list_idx(frame);
519 fr_idx = (FRLISTEN_64_SIZE +
520 dwc2_frame_list_idx(qh->next_active_frame) -
521 fr_idx_tmp) % dwc2_frame_incr_val(qh);
522 fr_idx = (fr_idx + fr_idx_tmp) % FRLISTEN_64_SIZE;
523 } else {
524 qh->next_active_frame = dwc2_calc_starting_frame(hsotg, qh,
525 &skip_frames);
526 fr_idx = dwc2_frame_list_idx(qh->next_active_frame);
527 }
528
529 qh->td_first = qh->td_last = dwc2_frame_to_desc_idx(qh, fr_idx);
530
531 return skip_frames;
532}
533
534#define ISOC_URB_GIVEBACK_ASAP
535
536#define MAX_ISOC_XFER_SIZE_FS 1023
537#define MAX_ISOC_XFER_SIZE_HS 3072
538#define DESCNUM_THRESHOLD 4
539
540static void dwc2_fill_host_isoc_dma_desc(struct dwc2_hsotg *hsotg,
541 struct dwc2_qtd *qtd,
542 struct dwc2_qh *qh, u32 max_xfer_size,
543 u16 idx)
544{
545 struct dwc2_hcd_dma_desc *dma_desc = &qh->desc_list[idx];
546 struct dwc2_hcd_iso_packet_desc *frame_desc;
547
548 memset(dma_desc, 0, sizeof(*dma_desc));
549 frame_desc = &qtd->urb->iso_descs[qtd->isoc_frame_index_last];
550
551 if (frame_desc->length > max_xfer_size)
552 qh->n_bytes[idx] = max_xfer_size;
553 else
554 qh->n_bytes[idx] = frame_desc->length;
555
556 dma_desc->buf = (u32)(qtd->urb->dma + frame_desc->offset);
557 dma_desc->status = qh->n_bytes[idx] << HOST_DMA_ISOC_NBYTES_SHIFT &
558 HOST_DMA_ISOC_NBYTES_MASK;
559
560 /* Set active bit */
561 dma_desc->status |= HOST_DMA_A;
562
563 qh->ntd++;
564 qtd->isoc_frame_index_last++;
565
566#ifdef ISOC_URB_GIVEBACK_ASAP
567 /* Set IOC for each descriptor corresponding to last frame of URB */
568 if (qtd->isoc_frame_index_last == qtd->urb->packet_count)
569 dma_desc->status |= HOST_DMA_IOC;
570#endif
571
572 dma_sync_single_for_device(hsotg->dev,
573 qh->desc_list_dma +
574 (idx * sizeof(struct dwc2_hcd_dma_desc)),
575 sizeof(struct dwc2_hcd_dma_desc),
576 DMA_TO_DEVICE);
577}
578
579static void dwc2_init_isoc_dma_desc(struct dwc2_hsotg *hsotg,
580 struct dwc2_qh *qh, u16 skip_frames)
581{
582 struct dwc2_qtd *qtd;
583 u32 max_xfer_size;
584 u16 idx, inc, n_desc = 0, ntd_max = 0;
585 u16 cur_idx;
586 u16 next_idx;
587
588 idx = qh->td_last;
589 inc = qh->host_interval;
590 hsotg->frame_number = dwc2_hcd_get_frame_number(hsotg);
591 cur_idx = dwc2_frame_list_idx(hsotg->frame_number);
592 next_idx = dwc2_desclist_idx_inc(qh->td_last, inc, qh->dev_speed);
593
594 /*
595 * Ensure current frame number didn't overstep last scheduled
596 * descriptor. If it happens, the only way to recover is to move
597 * qh->td_last to current frame number + 1.
598 * So that next isoc descriptor will be scheduled on frame number + 1
599 * and not on a past frame.
600 */
601 if (dwc2_frame_idx_num_gt(cur_idx, next_idx) || (cur_idx == next_idx)) {
602 if (inc < 32) {
603 dev_vdbg(hsotg->dev,
604 "current frame number overstep last descriptor\n");
605 qh->td_last = dwc2_desclist_idx_inc(cur_idx, inc,
606 qh->dev_speed);
607 idx = qh->td_last;
608 }
609 }
610
611 if (qh->host_interval) {
612 ntd_max = (dwc2_max_desc_num(qh) + qh->host_interval - 1) /
613 qh->host_interval;
614 if (skip_frames && !qh->channel)
615 ntd_max -= skip_frames / qh->host_interval;
616 }
617
618 max_xfer_size = qh->dev_speed == USB_SPEED_HIGH ?
619 MAX_ISOC_XFER_SIZE_HS : MAX_ISOC_XFER_SIZE_FS;
620
621 list_for_each_entry(qtd, &qh->qtd_list, qtd_list_entry) {
622 if (qtd->in_process &&
623 qtd->isoc_frame_index_last ==
624 qtd->urb->packet_count)
625 continue;
626
627 qtd->isoc_td_first = idx;
628 while (qh->ntd < ntd_max && qtd->isoc_frame_index_last <
629 qtd->urb->packet_count) {
630 dwc2_fill_host_isoc_dma_desc(hsotg, qtd, qh,
631 max_xfer_size, idx);
632 idx = dwc2_desclist_idx_inc(idx, inc, qh->dev_speed);
633 n_desc++;
634 }
635 qtd->isoc_td_last = idx;
636 qtd->in_process = 1;
637 }
638
639 qh->td_last = idx;
640
641#ifdef ISOC_URB_GIVEBACK_ASAP
642 /* Set IOC for last descriptor if descriptor list is full */
643 if (qh->ntd == ntd_max) {
644 idx = dwc2_desclist_idx_dec(qh->td_last, inc, qh->dev_speed);
645 qh->desc_list[idx].status |= HOST_DMA_IOC;
646 dma_sync_single_for_device(hsotg->dev,
647 qh->desc_list_dma + (idx *
648 sizeof(struct dwc2_hcd_dma_desc)),
649 sizeof(struct dwc2_hcd_dma_desc),
650 DMA_TO_DEVICE);
651 }
652#else
653 /*
654 * Set IOC bit only for one descriptor. Always try to be ahead of HW
655 * processing, i.e. on IOC generation driver activates next descriptor
656 * but core continues to process descriptors following the one with IOC
657 * set.
658 */
659
660 if (n_desc > DESCNUM_THRESHOLD)
661 /*
662 * Move IOC "up". Required even if there is only one QTD
663 * in the list, because QTDs might continue to be queued,
664 * but during the activation it was only one queued.
665 * Actually more than one QTD might be in the list if this
666 * function called from XferCompletion - QTDs was queued during
667 * HW processing of the previous descriptor chunk.
668 */
669 idx = dwc2_desclist_idx_dec(idx, inc * ((qh->ntd + 1) / 2),
670 qh->dev_speed);
671 else
672 /*
673 * Set the IOC for the latest descriptor if either number of
674 * descriptors is not greater than threshold or no more new
675 * descriptors activated
676 */
677 idx = dwc2_desclist_idx_dec(qh->td_last, inc, qh->dev_speed);
678
679 qh->desc_list[idx].status |= HOST_DMA_IOC;
680 dma_sync_single_for_device(hsotg->dev,
681 qh->desc_list_dma +
682 (idx * sizeof(struct dwc2_hcd_dma_desc)),
683 sizeof(struct dwc2_hcd_dma_desc),
684 DMA_TO_DEVICE);
685#endif
686}
687
688static void dwc2_fill_host_dma_desc(struct dwc2_hsotg *hsotg,
689 struct dwc2_host_chan *chan,
690 struct dwc2_qtd *qtd, struct dwc2_qh *qh,
691 int n_desc)
692{
693 struct dwc2_hcd_dma_desc *dma_desc = &qh->desc_list[n_desc];
694 int len = chan->xfer_len;
695
696 if (len > MAX_DMA_DESC_SIZE - (chan->max_packet - 1))
697 len = MAX_DMA_DESC_SIZE - (chan->max_packet - 1);
698
699 if (chan->ep_is_in) {
700 int num_packets;
701
702 if (len > 0 && chan->max_packet)
703 num_packets = (len + chan->max_packet - 1)
704 / chan->max_packet;
705 else
706 /* Need 1 packet for transfer length of 0 */
707 num_packets = 1;
708
709 /* Always program an integral # of packets for IN transfers */
710 len = num_packets * chan->max_packet;
711 }
712
713 dma_desc->status = len << HOST_DMA_NBYTES_SHIFT & HOST_DMA_NBYTES_MASK;
714 qh->n_bytes[n_desc] = len;
715
716 if (qh->ep_type == USB_ENDPOINT_XFER_CONTROL &&
717 qtd->control_phase == DWC2_CONTROL_SETUP)
718 dma_desc->status |= HOST_DMA_SUP;
719
720 dma_desc->buf = (u32)chan->xfer_dma;
721
722 dma_sync_single_for_device(hsotg->dev,
723 qh->desc_list_dma +
724 (n_desc * sizeof(struct dwc2_hcd_dma_desc)),
725 sizeof(struct dwc2_hcd_dma_desc),
726 DMA_TO_DEVICE);
727
728 /*
729 * Last (or only) descriptor of IN transfer with actual size less
730 * than MaxPacket
731 */
732 if (len > chan->xfer_len) {
733 chan->xfer_len = 0;
734 } else {
735 chan->xfer_dma += len;
736 chan->xfer_len -= len;
737 }
738}
739
740static void dwc2_init_non_isoc_dma_desc(struct dwc2_hsotg *hsotg,
741 struct dwc2_qh *qh)
742{
743 struct dwc2_qtd *qtd;
744 struct dwc2_host_chan *chan = qh->channel;
745 int n_desc = 0;
746
747 dev_vdbg(hsotg->dev, "%s(): qh=%p dma=%08lx len=%d\n", __func__, qh,
748 (unsigned long)chan->xfer_dma, chan->xfer_len);
749
750 /*
751 * Start with chan->xfer_dma initialized in assign_and_init_hc(), then
752 * if SG transfer consists of multiple URBs, this pointer is re-assigned
753 * to the buffer of the currently processed QTD. For non-SG request
754 * there is always one QTD active.
755 */
756
757 list_for_each_entry(qtd, &qh->qtd_list, qtd_list_entry) {
758 dev_vdbg(hsotg->dev, "qtd=%p\n", qtd);
759
760 if (n_desc) {
761 /* SG request - more than 1 QTD */
762 chan->xfer_dma = qtd->urb->dma +
763 qtd->urb->actual_length;
764 chan->xfer_len = qtd->urb->length -
765 qtd->urb->actual_length;
766 dev_vdbg(hsotg->dev, "buf=%08lx len=%d\n",
767 (unsigned long)chan->xfer_dma, chan->xfer_len);
768 }
769
770 qtd->n_desc = 0;
771 do {
772 if (n_desc > 1) {
773 qh->desc_list[n_desc - 1].status |= HOST_DMA_A;
774 dev_vdbg(hsotg->dev,
775 "set A bit in desc %d (%p)\n",
776 n_desc - 1,
777 &qh->desc_list[n_desc - 1]);
778 dma_sync_single_for_device(hsotg->dev,
779 qh->desc_list_dma +
780 ((n_desc - 1) *
781 sizeof(struct dwc2_hcd_dma_desc)),
782 sizeof(struct dwc2_hcd_dma_desc),
783 DMA_TO_DEVICE);
784 }
785 dwc2_fill_host_dma_desc(hsotg, chan, qtd, qh, n_desc);
786 dev_vdbg(hsotg->dev,
787 "desc %d (%p) buf=%08x status=%08x\n",
788 n_desc, &qh->desc_list[n_desc],
789 qh->desc_list[n_desc].buf,
790 qh->desc_list[n_desc].status);
791 qtd->n_desc++;
792 n_desc++;
793 } while (chan->xfer_len > 0 &&
794 n_desc != MAX_DMA_DESC_NUM_GENERIC);
795
796 dev_vdbg(hsotg->dev, "n_desc=%d\n", n_desc);
797 qtd->in_process = 1;
798 if (qh->ep_type == USB_ENDPOINT_XFER_CONTROL)
799 break;
800 if (n_desc == MAX_DMA_DESC_NUM_GENERIC)
801 break;
802 }
803
804 if (n_desc) {
805 qh->desc_list[n_desc - 1].status |=
806 HOST_DMA_IOC | HOST_DMA_EOL | HOST_DMA_A;
807 dev_vdbg(hsotg->dev, "set IOC/EOL/A bits in desc %d (%p)\n",
808 n_desc - 1, &qh->desc_list[n_desc - 1]);
809 dma_sync_single_for_device(hsotg->dev,
810 qh->desc_list_dma + (n_desc - 1) *
811 sizeof(struct dwc2_hcd_dma_desc),
812 sizeof(struct dwc2_hcd_dma_desc),
813 DMA_TO_DEVICE);
814 if (n_desc > 1) {
815 qh->desc_list[0].status |= HOST_DMA_A;
816 dev_vdbg(hsotg->dev, "set A bit in desc 0 (%p)\n",
817 &qh->desc_list[0]);
818 dma_sync_single_for_device(hsotg->dev,
819 qh->desc_list_dma,
820 sizeof(struct dwc2_hcd_dma_desc),
821 DMA_TO_DEVICE);
822 }
823 chan->ntd = n_desc;
824 }
825}
826
827/**
828 * dwc2_hcd_start_xfer_ddma() - Starts a transfer in Descriptor DMA mode
829 *
830 * @hsotg: The HCD state structure for the DWC OTG controller
831 * @qh: The QH to init
832 *
833 * Return: 0 if successful, negative error code otherwise
834 *
835 * For Control and Bulk endpoints, initializes descriptor list and starts the
836 * transfer. For Interrupt and Isochronous endpoints, initializes descriptor
837 * list then updates FrameList, marking appropriate entries as active.
838 *
839 * For Isochronous endpoints the starting descriptor index is calculated based
840 * on the scheduled frame, but only on the first transfer descriptor within a
841 * session. Then the transfer is started via enabling the channel.
842 *
843 * For Isochronous endpoints the channel is not halted on XferComplete
844 * interrupt so remains assigned to the endpoint(QH) until session is done.
845 */
846void dwc2_hcd_start_xfer_ddma(struct dwc2_hsotg *hsotg, struct dwc2_qh *qh)
847{
848 /* Channel is already assigned */
849 struct dwc2_host_chan *chan = qh->channel;
850 u16 skip_frames = 0;
851
852 switch (chan->ep_type) {
853 case USB_ENDPOINT_XFER_CONTROL:
854 case USB_ENDPOINT_XFER_BULK:
855 dwc2_init_non_isoc_dma_desc(hsotg, qh);
856 dwc2_hc_start_transfer_ddma(hsotg, chan);
857 break;
858 case USB_ENDPOINT_XFER_INT:
859 dwc2_init_non_isoc_dma_desc(hsotg, qh);
860 dwc2_update_frame_list(hsotg, qh, 1);
861 dwc2_hc_start_transfer_ddma(hsotg, chan);
862 break;
863 case USB_ENDPOINT_XFER_ISOC:
864 if (!qh->ntd)
865 skip_frames = dwc2_recalc_initial_desc_idx(hsotg, qh);
866 dwc2_init_isoc_dma_desc(hsotg, qh, skip_frames);
867
868 if (!chan->xfer_started) {
869 dwc2_update_frame_list(hsotg, qh, 1);
870
871 /*
872 * Always set to max, instead of actual size. Otherwise
873 * ntd will be changed with channel being enabled. Not
874 * recommended.
875 */
876 chan->ntd = dwc2_max_desc_num(qh);
877
878 /* Enable channel only once for ISOC */
879 dwc2_hc_start_transfer_ddma(hsotg, chan);
880 }
881
882 break;
883 default:
884 break;
885 }
886}
887
888#define DWC2_CMPL_DONE 1
889#define DWC2_CMPL_STOP 2
890
891static int dwc2_cmpl_host_isoc_dma_desc(struct dwc2_hsotg *hsotg,
892 struct dwc2_host_chan *chan,
893 struct dwc2_qtd *qtd,
894 struct dwc2_qh *qh, u16 idx)
895{
896 struct dwc2_hcd_dma_desc *dma_desc;
897 struct dwc2_hcd_iso_packet_desc *frame_desc;
898 u16 remain = 0;
899 int rc = 0;
900
901 if (!qtd->urb)
902 return -EINVAL;
903
904 dma_sync_single_for_cpu(hsotg->dev, qh->desc_list_dma + (idx *
905 sizeof(struct dwc2_hcd_dma_desc)),
906 sizeof(struct dwc2_hcd_dma_desc),
907 DMA_FROM_DEVICE);
908
909 dma_desc = &qh->desc_list[idx];
910
911 frame_desc = &qtd->urb->iso_descs[qtd->isoc_frame_index_last];
912 dma_desc->buf = (u32)(qtd->urb->dma + frame_desc->offset);
913 if (chan->ep_is_in)
914 remain = (dma_desc->status & HOST_DMA_ISOC_NBYTES_MASK) >>
915 HOST_DMA_ISOC_NBYTES_SHIFT;
916
917 if ((dma_desc->status & HOST_DMA_STS_MASK) == HOST_DMA_STS_PKTERR) {
918 /*
919 * XactError, or unable to complete all the transactions
920 * in the scheduled micro-frame/frame, both indicated by
921 * HOST_DMA_STS_PKTERR
922 */
923 qtd->urb->error_count++;
924 frame_desc->actual_length = qh->n_bytes[idx] - remain;
925 frame_desc->status = -EPROTO;
926 } else {
927 /* Success */
928 frame_desc->actual_length = qh->n_bytes[idx] - remain;
929 frame_desc->status = 0;
930 }
931
932 if (++qtd->isoc_frame_index == qtd->urb->packet_count) {
933 /*
934 * urb->status is not used for isoc transfers here. The
935 * individual frame_desc status are used instead.
936 */
937 dwc2_host_complete(hsotg, qtd, 0);
938 dwc2_hcd_qtd_unlink_and_free(hsotg, qtd, qh);
939
940 /*
941 * This check is necessary because urb_dequeue can be called
942 * from urb complete callback (sound driver for example). All
943 * pending URBs are dequeued there, so no need for further
944 * processing.
945 */
946 if (chan->halt_status == DWC2_HC_XFER_URB_DEQUEUE)
947 return -1;
948 rc = DWC2_CMPL_DONE;
949 }
950
951 qh->ntd--;
952
953 /* Stop if IOC requested descriptor reached */
954 if (dma_desc->status & HOST_DMA_IOC)
955 rc = DWC2_CMPL_STOP;
956
957 return rc;
958}
959
960static void dwc2_complete_isoc_xfer_ddma(struct dwc2_hsotg *hsotg,
961 struct dwc2_host_chan *chan,
962 enum dwc2_halt_status halt_status)
963{
964 struct dwc2_hcd_iso_packet_desc *frame_desc;
965 struct dwc2_qtd *qtd, *qtd_tmp;
966 struct dwc2_qh *qh;
967 u16 idx;
968 int rc;
969
970 qh = chan->qh;
971 idx = qh->td_first;
972
973 if (chan->halt_status == DWC2_HC_XFER_URB_DEQUEUE) {
974 list_for_each_entry(qtd, &qh->qtd_list, qtd_list_entry)
975 qtd->in_process = 0;
976 return;
977 }
978
979 if (halt_status == DWC2_HC_XFER_AHB_ERR ||
980 halt_status == DWC2_HC_XFER_BABBLE_ERR) {
981 /*
982 * Channel is halted in these error cases, considered as serious
983 * issues.
984 * Complete all URBs marking all frames as failed, irrespective
985 * whether some of the descriptors (frames) succeeded or not.
986 * Pass error code to completion routine as well, to update
987 * urb->status, some of class drivers might use it to stop
988 * queing transfer requests.
989 */
990 int err = halt_status == DWC2_HC_XFER_AHB_ERR ?
991 -EIO : -EOVERFLOW;
992
993 list_for_each_entry_safe(qtd, qtd_tmp, &qh->qtd_list,
994 qtd_list_entry) {
995 if (qtd->urb) {
996 for (idx = 0; idx < qtd->urb->packet_count;
997 idx++) {
998 frame_desc = &qtd->urb->iso_descs[idx];
999 frame_desc->status = err;
1000 }
1001
1002 dwc2_host_complete(hsotg, qtd, err);
1003 }
1004
1005 dwc2_hcd_qtd_unlink_and_free(hsotg, qtd, qh);
1006 }
1007
1008 return;
1009 }
1010
1011 list_for_each_entry_safe(qtd, qtd_tmp, &qh->qtd_list, qtd_list_entry) {
1012 if (!qtd->in_process)
1013 break;
1014
1015 /*
1016 * Ensure idx corresponds to descriptor where first urb of this
1017 * qtd was added. In fact, during isoc desc init, dwc2 may skip
1018 * an index if current frame number is already over this index.
1019 */
1020 if (idx != qtd->isoc_td_first) {
1021 dev_vdbg(hsotg->dev,
1022 "try to complete %d instead of %d\n",
1023 idx, qtd->isoc_td_first);
1024 idx = qtd->isoc_td_first;
1025 }
1026
1027 do {
1028 struct dwc2_qtd *qtd_next;
1029 u16 cur_idx;
1030
1031 rc = dwc2_cmpl_host_isoc_dma_desc(hsotg, chan, qtd, qh,
1032 idx);
1033 if (rc < 0)
1034 return;
1035 idx = dwc2_desclist_idx_inc(idx, qh->host_interval,
1036 chan->speed);
1037 if (!rc)
1038 continue;
1039
1040 if (rc == DWC2_CMPL_DONE)
1041 break;
1042
1043 /* rc == DWC2_CMPL_STOP */
1044
1045 if (qh->host_interval >= 32)
1046 goto stop_scan;
1047
1048 qh->td_first = idx;
1049 cur_idx = dwc2_frame_list_idx(hsotg->frame_number);
1050 qtd_next = list_first_entry(&qh->qtd_list,
1051 struct dwc2_qtd,
1052 qtd_list_entry);
1053 if (dwc2_frame_idx_num_gt(cur_idx,
1054 qtd_next->isoc_td_last))
1055 break;
1056
1057 goto stop_scan;
1058
1059 } while (idx != qh->td_first);
1060 }
1061
1062stop_scan:
1063 qh->td_first = idx;
1064}
1065
1066static int dwc2_update_non_isoc_urb_state_ddma(struct dwc2_hsotg *hsotg,
1067 struct dwc2_host_chan *chan,
1068 struct dwc2_qtd *qtd,
1069 struct dwc2_hcd_dma_desc *dma_desc,
1070 enum dwc2_halt_status halt_status,
1071 u32 n_bytes, int *xfer_done)
1072{
1073 struct dwc2_hcd_urb *urb = qtd->urb;
1074 u16 remain = 0;
1075
1076 if (chan->ep_is_in)
1077 remain = (dma_desc->status & HOST_DMA_NBYTES_MASK) >>
1078 HOST_DMA_NBYTES_SHIFT;
1079
1080 dev_vdbg(hsotg->dev, "remain=%d dwc2_urb=%p\n", remain, urb);
1081
1082 if (halt_status == DWC2_HC_XFER_AHB_ERR) {
1083 dev_err(hsotg->dev, "EIO\n");
1084 urb->status = -EIO;
1085 return 1;
1086 }
1087
1088 if ((dma_desc->status & HOST_DMA_STS_MASK) == HOST_DMA_STS_PKTERR) {
1089 switch (halt_status) {
1090 case DWC2_HC_XFER_STALL:
1091 dev_vdbg(hsotg->dev, "Stall\n");
1092 urb->status = -EPIPE;
1093 break;
1094 case DWC2_HC_XFER_BABBLE_ERR:
1095 dev_err(hsotg->dev, "Babble\n");
1096 urb->status = -EOVERFLOW;
1097 break;
1098 case DWC2_HC_XFER_XACT_ERR:
1099 dev_err(hsotg->dev, "XactErr\n");
1100 urb->status = -EPROTO;
1101 break;
1102 default:
1103 dev_err(hsotg->dev,
1104 "%s: Unhandled descriptor error status (%d)\n",
1105 __func__, halt_status);
1106 break;
1107 }
1108 return 1;
1109 }
1110
1111 if (dma_desc->status & HOST_DMA_A) {
1112 dev_vdbg(hsotg->dev,
1113 "Active descriptor encountered on channel %d\n",
1114 chan->hc_num);
1115 return 0;
1116 }
1117
1118 if (chan->ep_type == USB_ENDPOINT_XFER_CONTROL) {
1119 if (qtd->control_phase == DWC2_CONTROL_DATA) {
1120 urb->actual_length += n_bytes - remain;
1121 if (remain || urb->actual_length >= urb->length) {
1122 /*
1123 * For Control Data stage do not set urb->status
1124 * to 0, to prevent URB callback. Set it when
1125 * Status phase is done. See below.
1126 */
1127 *xfer_done = 1;
1128 }
1129 } else if (qtd->control_phase == DWC2_CONTROL_STATUS) {
1130 urb->status = 0;
1131 *xfer_done = 1;
1132 }
1133 /* No handling for SETUP stage */
1134 } else {
1135 /* BULK and INTR */
1136 urb->actual_length += n_bytes - remain;
1137 dev_vdbg(hsotg->dev, "length=%d actual=%d\n", urb->length,
1138 urb->actual_length);
1139 if (remain || urb->actual_length >= urb->length) {
1140 urb->status = 0;
1141 *xfer_done = 1;
1142 }
1143 }
1144
1145 return 0;
1146}
1147
1148static int dwc2_process_non_isoc_desc(struct dwc2_hsotg *hsotg,
1149 struct dwc2_host_chan *chan,
1150 int chnum, struct dwc2_qtd *qtd,
1151 int desc_num,
1152 enum dwc2_halt_status halt_status,
1153 int *xfer_done)
1154{
1155 struct dwc2_qh *qh = chan->qh;
1156 struct dwc2_hcd_urb *urb = qtd->urb;
1157 struct dwc2_hcd_dma_desc *dma_desc;
1158 u32 n_bytes;
1159 int failed;
1160
1161 dev_vdbg(hsotg->dev, "%s()\n", __func__);
1162
1163 if (!urb)
1164 return -EINVAL;
1165
1166 dma_sync_single_for_cpu(hsotg->dev,
1167 qh->desc_list_dma + (desc_num *
1168 sizeof(struct dwc2_hcd_dma_desc)),
1169 sizeof(struct dwc2_hcd_dma_desc),
1170 DMA_FROM_DEVICE);
1171
1172 dma_desc = &qh->desc_list[desc_num];
1173 n_bytes = qh->n_bytes[desc_num];
1174 dev_vdbg(hsotg->dev,
1175 "qtd=%p dwc2_urb=%p desc_num=%d desc=%p n_bytes=%d\n",
1176 qtd, urb, desc_num, dma_desc, n_bytes);
1177 failed = dwc2_update_non_isoc_urb_state_ddma(hsotg, chan, qtd, dma_desc,
1178 halt_status, n_bytes,
1179 xfer_done);
1180 if (failed || (*xfer_done && urb->status != -EINPROGRESS)) {
1181 dwc2_host_complete(hsotg, qtd, urb->status);
1182 dwc2_hcd_qtd_unlink_and_free(hsotg, qtd, qh);
1183 dev_vdbg(hsotg->dev, "failed=%1x xfer_done=%1x\n",
1184 failed, *xfer_done);
1185 return failed;
1186 }
1187
1188 if (qh->ep_type == USB_ENDPOINT_XFER_CONTROL) {
1189 switch (qtd->control_phase) {
1190 case DWC2_CONTROL_SETUP:
1191 if (urb->length > 0)
1192 qtd->control_phase = DWC2_CONTROL_DATA;
1193 else
1194 qtd->control_phase = DWC2_CONTROL_STATUS;
1195 dev_vdbg(hsotg->dev,
1196 " Control setup transaction done\n");
1197 break;
1198 case DWC2_CONTROL_DATA:
1199 if (*xfer_done) {
1200 qtd->control_phase = DWC2_CONTROL_STATUS;
1201 dev_vdbg(hsotg->dev,
1202 " Control data transfer done\n");
1203 } else if (desc_num + 1 == qtd->n_desc) {
1204 /*
1205 * Last descriptor for Control data stage which
1206 * is not completed yet
1207 */
1208 dwc2_hcd_save_data_toggle(hsotg, chan, chnum,
1209 qtd);
1210 }
1211 break;
1212 default:
1213 break;
1214 }
1215 }
1216
1217 return 0;
1218}
1219
1220static void dwc2_complete_non_isoc_xfer_ddma(struct dwc2_hsotg *hsotg,
1221 struct dwc2_host_chan *chan,
1222 int chnum,
1223 enum dwc2_halt_status halt_status)
1224{
1225 struct list_head *qtd_item, *qtd_tmp;
1226 struct dwc2_qh *qh = chan->qh;
1227 struct dwc2_qtd *qtd = NULL;
1228 int xfer_done;
1229 int desc_num = 0;
1230
1231 if (chan->halt_status == DWC2_HC_XFER_URB_DEQUEUE) {
1232 list_for_each_entry(qtd, &qh->qtd_list, qtd_list_entry)
1233 qtd->in_process = 0;
1234 return;
1235 }
1236
1237 list_for_each_safe(qtd_item, qtd_tmp, &qh->qtd_list) {
1238 int i;
1239 int qtd_desc_count;
1240
1241 qtd = list_entry(qtd_item, struct dwc2_qtd, qtd_list_entry);
1242 xfer_done = 0;
1243 qtd_desc_count = qtd->n_desc;
1244
1245 for (i = 0; i < qtd_desc_count; i++) {
1246 if (dwc2_process_non_isoc_desc(hsotg, chan, chnum, qtd,
1247 desc_num, halt_status,
1248 &xfer_done)) {
1249 qtd = NULL;
1250 goto stop_scan;
1251 }
1252
1253 desc_num++;
1254 }
1255 }
1256
1257stop_scan:
1258 if (qh->ep_type != USB_ENDPOINT_XFER_CONTROL) {
1259 /*
1260 * Resetting the data toggle for bulk and interrupt endpoints
1261 * in case of stall. See handle_hc_stall_intr().
1262 */
1263 if (halt_status == DWC2_HC_XFER_STALL)
1264 qh->data_toggle = DWC2_HC_PID_DATA0;
1265 else
1266 dwc2_hcd_save_data_toggle(hsotg, chan, chnum, NULL);
1267 }
1268
1269 if (halt_status == DWC2_HC_XFER_COMPLETE) {
1270 if (chan->hcint & HCINTMSK_NYET) {
1271 /*
1272 * Got a NYET on the last transaction of the transfer.
1273 * It means that the endpoint should be in the PING
1274 * state at the beginning of the next transfer.
1275 */
1276 qh->ping_state = 1;
1277 }
1278 }
1279}
1280
1281/**
1282 * dwc2_hcd_complete_xfer_ddma() - Scans the descriptor list, updates URB's
1283 * status and calls completion routine for the URB if it's done. Called from
1284 * interrupt handlers.
1285 *
1286 * @hsotg: The HCD state structure for the DWC OTG controller
1287 * @chan: Host channel the transfer is completed on
1288 * @chnum: Index of Host channel registers
1289 * @halt_status: Reason the channel is being halted or just XferComplete
1290 * for isochronous transfers
1291 *
1292 * Releases the channel to be used by other transfers.
1293 * In case of Isochronous endpoint the channel is not halted until the end of
1294 * the session, i.e. QTD list is empty.
1295 * If periodic channel released the FrameList is updated accordingly.
1296 * Calls transaction selection routines to activate pending transfers.
1297 */
1298void dwc2_hcd_complete_xfer_ddma(struct dwc2_hsotg *hsotg,
1299 struct dwc2_host_chan *chan, int chnum,
1300 enum dwc2_halt_status halt_status)
1301{
1302 struct dwc2_qh *qh = chan->qh;
1303 int continue_isoc_xfer = 0;
1304 enum dwc2_transaction_type tr_type;
1305
1306 if (chan->ep_type == USB_ENDPOINT_XFER_ISOC) {
1307 dwc2_complete_isoc_xfer_ddma(hsotg, chan, halt_status);
1308
1309 /* Release the channel if halted or session completed */
1310 if (halt_status != DWC2_HC_XFER_COMPLETE ||
1311 list_empty(&qh->qtd_list)) {
1312 struct dwc2_qtd *qtd, *qtd_tmp;
1313
1314 /*
1315 * Kill all remainings QTDs since channel has been
1316 * halted.
1317 */
1318 list_for_each_entry_safe(qtd, qtd_tmp,
1319 &qh->qtd_list,
1320 qtd_list_entry) {
1321 dwc2_host_complete(hsotg, qtd,
1322 -ECONNRESET);
1323 dwc2_hcd_qtd_unlink_and_free(hsotg,
1324 qtd, qh);
1325 }
1326
1327 /* Halt the channel if session completed */
1328 if (halt_status == DWC2_HC_XFER_COMPLETE)
1329 dwc2_hc_halt(hsotg, chan, halt_status);
1330 dwc2_release_channel_ddma(hsotg, qh);
1331 dwc2_hcd_qh_unlink(hsotg, qh);
1332 } else {
1333 /* Keep in assigned schedule to continue transfer */
1334 list_move_tail(&qh->qh_list_entry,
1335 &hsotg->periodic_sched_assigned);
1336 /*
1337 * If channel has been halted during giveback of urb
1338 * then prevent any new scheduling.
1339 */
1340 if (!chan->halt_status)
1341 continue_isoc_xfer = 1;
1342 }
1343 /*
1344 * Todo: Consider the case when period exceeds FrameList size.
1345 * Frame Rollover interrupt should be used.
1346 */
1347 } else {
1348 /*
1349 * Scan descriptor list to complete the URB(s), then release
1350 * the channel
1351 */
1352 dwc2_complete_non_isoc_xfer_ddma(hsotg, chan, chnum,
1353 halt_status);
1354 dwc2_release_channel_ddma(hsotg, qh);
1355 dwc2_hcd_qh_unlink(hsotg, qh);
1356
1357 if (!list_empty(&qh->qtd_list)) {
1358 /*
1359 * Add back to inactive non-periodic schedule on normal
1360 * completion
1361 */
1362 dwc2_hcd_qh_add(hsotg, qh);
1363 }
1364 }
1365
1366 tr_type = dwc2_hcd_select_transactions(hsotg);
1367 if (tr_type != DWC2_TRANSACTION_NONE || continue_isoc_xfer) {
1368 if (continue_isoc_xfer) {
1369 if (tr_type == DWC2_TRANSACTION_NONE)
1370 tr_type = DWC2_TRANSACTION_PERIODIC;
1371 else if (tr_type == DWC2_TRANSACTION_NON_PERIODIC)
1372 tr_type = DWC2_TRANSACTION_ALL;
1373 }
1374 dwc2_hcd_queue_transactions(hsotg, tr_type);
1375 }
1376}
1// SPDX-License-Identifier: (GPL-2.0+ OR BSD-3-Clause)
2/*
3 * hcd_ddma.c - DesignWare HS OTG Controller descriptor DMA routines
4 *
5 * Copyright (C) 2004-2013 Synopsys, Inc.
6 */
7
8/*
9 * This file contains the Descriptor DMA implementation for Host mode
10 */
11#include <linux/kernel.h>
12#include <linux/module.h>
13#include <linux/spinlock.h>
14#include <linux/interrupt.h>
15#include <linux/dma-mapping.h>
16#include <linux/io.h>
17#include <linux/slab.h>
18#include <linux/usb.h>
19
20#include <linux/usb/hcd.h>
21#include <linux/usb/ch11.h>
22
23#include "core.h"
24#include "hcd.h"
25
26static u16 dwc2_frame_list_idx(u16 frame)
27{
28 return frame & (FRLISTEN_64_SIZE - 1);
29}
30
31static u16 dwc2_desclist_idx_inc(u16 idx, u16 inc, u8 speed)
32{
33 return (idx + inc) &
34 ((speed == USB_SPEED_HIGH ? MAX_DMA_DESC_NUM_HS_ISOC :
35 MAX_DMA_DESC_NUM_GENERIC) - 1);
36}
37
38static u16 dwc2_desclist_idx_dec(u16 idx, u16 inc, u8 speed)
39{
40 return (idx - inc) &
41 ((speed == USB_SPEED_HIGH ? MAX_DMA_DESC_NUM_HS_ISOC :
42 MAX_DMA_DESC_NUM_GENERIC) - 1);
43}
44
45static u16 dwc2_max_desc_num(struct dwc2_qh *qh)
46{
47 return (qh->ep_type == USB_ENDPOINT_XFER_ISOC &&
48 qh->dev_speed == USB_SPEED_HIGH) ?
49 MAX_DMA_DESC_NUM_HS_ISOC : MAX_DMA_DESC_NUM_GENERIC;
50}
51
52static u16 dwc2_frame_incr_val(struct dwc2_qh *qh)
53{
54 return qh->dev_speed == USB_SPEED_HIGH ?
55 (qh->host_interval + 8 - 1) / 8 : qh->host_interval;
56}
57
58static int dwc2_desc_list_alloc(struct dwc2_hsotg *hsotg, struct dwc2_qh *qh,
59 gfp_t flags)
60{
61 struct kmem_cache *desc_cache;
62
63 if (qh->ep_type == USB_ENDPOINT_XFER_ISOC &&
64 qh->dev_speed == USB_SPEED_HIGH)
65 desc_cache = hsotg->desc_hsisoc_cache;
66 else
67 desc_cache = hsotg->desc_gen_cache;
68
69 qh->desc_list_sz = sizeof(struct dwc2_dma_desc) *
70 dwc2_max_desc_num(qh);
71
72 qh->desc_list = kmem_cache_zalloc(desc_cache, flags | GFP_DMA);
73 if (!qh->desc_list)
74 return -ENOMEM;
75
76 qh->desc_list_dma = dma_map_single(hsotg->dev, qh->desc_list,
77 qh->desc_list_sz,
78 DMA_TO_DEVICE);
79
80 qh->n_bytes = kcalloc(dwc2_max_desc_num(qh), sizeof(u32), flags);
81 if (!qh->n_bytes) {
82 dma_unmap_single(hsotg->dev, qh->desc_list_dma,
83 qh->desc_list_sz,
84 DMA_FROM_DEVICE);
85 kmem_cache_free(desc_cache, qh->desc_list);
86 qh->desc_list = NULL;
87 return -ENOMEM;
88 }
89
90 return 0;
91}
92
93static void dwc2_desc_list_free(struct dwc2_hsotg *hsotg, struct dwc2_qh *qh)
94{
95 struct kmem_cache *desc_cache;
96
97 if (qh->ep_type == USB_ENDPOINT_XFER_ISOC &&
98 qh->dev_speed == USB_SPEED_HIGH)
99 desc_cache = hsotg->desc_hsisoc_cache;
100 else
101 desc_cache = hsotg->desc_gen_cache;
102
103 if (qh->desc_list) {
104 dma_unmap_single(hsotg->dev, qh->desc_list_dma,
105 qh->desc_list_sz, DMA_FROM_DEVICE);
106 kmem_cache_free(desc_cache, qh->desc_list);
107 qh->desc_list = NULL;
108 }
109
110 kfree(qh->n_bytes);
111 qh->n_bytes = NULL;
112}
113
114static int dwc2_frame_list_alloc(struct dwc2_hsotg *hsotg, gfp_t mem_flags)
115{
116 if (hsotg->frame_list)
117 return 0;
118
119 hsotg->frame_list_sz = 4 * FRLISTEN_64_SIZE;
120 hsotg->frame_list = kzalloc(hsotg->frame_list_sz, GFP_ATOMIC | GFP_DMA);
121 if (!hsotg->frame_list)
122 return -ENOMEM;
123
124 hsotg->frame_list_dma = dma_map_single(hsotg->dev, hsotg->frame_list,
125 hsotg->frame_list_sz,
126 DMA_TO_DEVICE);
127
128 return 0;
129}
130
131static void dwc2_frame_list_free(struct dwc2_hsotg *hsotg)
132{
133 unsigned long flags;
134
135 spin_lock_irqsave(&hsotg->lock, flags);
136
137 if (!hsotg->frame_list) {
138 spin_unlock_irqrestore(&hsotg->lock, flags);
139 return;
140 }
141
142 dma_unmap_single(hsotg->dev, hsotg->frame_list_dma,
143 hsotg->frame_list_sz, DMA_FROM_DEVICE);
144
145 kfree(hsotg->frame_list);
146 hsotg->frame_list = NULL;
147
148 spin_unlock_irqrestore(&hsotg->lock, flags);
149}
150
151static void dwc2_per_sched_enable(struct dwc2_hsotg *hsotg, u32 fr_list_en)
152{
153 u32 hcfg;
154 unsigned long flags;
155
156 spin_lock_irqsave(&hsotg->lock, flags);
157
158 hcfg = dwc2_readl(hsotg, HCFG);
159 if (hcfg & HCFG_PERSCHEDENA) {
160 /* already enabled */
161 spin_unlock_irqrestore(&hsotg->lock, flags);
162 return;
163 }
164
165 dwc2_writel(hsotg, hsotg->frame_list_dma, HFLBADDR);
166
167 hcfg &= ~HCFG_FRLISTEN_MASK;
168 hcfg |= fr_list_en | HCFG_PERSCHEDENA;
169 dev_vdbg(hsotg->dev, "Enabling Periodic schedule\n");
170 dwc2_writel(hsotg, hcfg, HCFG);
171
172 spin_unlock_irqrestore(&hsotg->lock, flags);
173}
174
175static void dwc2_per_sched_disable(struct dwc2_hsotg *hsotg)
176{
177 u32 hcfg;
178 unsigned long flags;
179
180 spin_lock_irqsave(&hsotg->lock, flags);
181
182 hcfg = dwc2_readl(hsotg, HCFG);
183 if (!(hcfg & HCFG_PERSCHEDENA)) {
184 /* already disabled */
185 spin_unlock_irqrestore(&hsotg->lock, flags);
186 return;
187 }
188
189 hcfg &= ~HCFG_PERSCHEDENA;
190 dev_vdbg(hsotg->dev, "Disabling Periodic schedule\n");
191 dwc2_writel(hsotg, hcfg, HCFG);
192
193 spin_unlock_irqrestore(&hsotg->lock, flags);
194}
195
196/*
197 * Activates/Deactivates FrameList entries for the channel based on endpoint
198 * servicing period
199 */
200static void dwc2_update_frame_list(struct dwc2_hsotg *hsotg, struct dwc2_qh *qh,
201 int enable)
202{
203 struct dwc2_host_chan *chan;
204 u16 i, j, inc;
205
206 if (!hsotg) {
207 pr_err("hsotg = %p\n", hsotg);
208 return;
209 }
210
211 if (!qh->channel) {
212 dev_err(hsotg->dev, "qh->channel = %p\n", qh->channel);
213 return;
214 }
215
216 if (!hsotg->frame_list) {
217 dev_err(hsotg->dev, "hsotg->frame_list = %p\n",
218 hsotg->frame_list);
219 return;
220 }
221
222 chan = qh->channel;
223 inc = dwc2_frame_incr_val(qh);
224 if (qh->ep_type == USB_ENDPOINT_XFER_ISOC)
225 i = dwc2_frame_list_idx(qh->next_active_frame);
226 else
227 i = 0;
228
229 j = i;
230 do {
231 if (enable)
232 hsotg->frame_list[j] |= 1 << chan->hc_num;
233 else
234 hsotg->frame_list[j] &= ~(1 << chan->hc_num);
235 j = (j + inc) & (FRLISTEN_64_SIZE - 1);
236 } while (j != i);
237
238 /*
239 * Sync frame list since controller will access it if periodic
240 * channel is currently enabled.
241 */
242 dma_sync_single_for_device(hsotg->dev,
243 hsotg->frame_list_dma,
244 hsotg->frame_list_sz,
245 DMA_TO_DEVICE);
246
247 if (!enable)
248 return;
249
250 chan->schinfo = 0;
251 if (chan->speed == USB_SPEED_HIGH && qh->host_interval) {
252 j = 1;
253 /* TODO - check this */
254 inc = (8 + qh->host_interval - 1) / qh->host_interval;
255 for (i = 0; i < inc; i++) {
256 chan->schinfo |= j;
257 j = j << qh->host_interval;
258 }
259 } else {
260 chan->schinfo = 0xff;
261 }
262}
263
264static void dwc2_release_channel_ddma(struct dwc2_hsotg *hsotg,
265 struct dwc2_qh *qh)
266{
267 struct dwc2_host_chan *chan = qh->channel;
268
269 if (dwc2_qh_is_non_per(qh)) {
270 if (hsotg->params.uframe_sched)
271 hsotg->available_host_channels++;
272 else
273 hsotg->non_periodic_channels--;
274 } else {
275 dwc2_update_frame_list(hsotg, qh, 0);
276 hsotg->available_host_channels++;
277 }
278
279 /*
280 * The condition is added to prevent double cleanup try in case of
281 * device disconnect. See channel cleanup in dwc2_hcd_disconnect().
282 */
283 if (chan->qh) {
284 if (!list_empty(&chan->hc_list_entry))
285 list_del(&chan->hc_list_entry);
286 dwc2_hc_cleanup(hsotg, chan);
287 list_add_tail(&chan->hc_list_entry, &hsotg->free_hc_list);
288 chan->qh = NULL;
289 }
290
291 qh->channel = NULL;
292 qh->ntd = 0;
293
294 if (qh->desc_list)
295 memset(qh->desc_list, 0, sizeof(struct dwc2_dma_desc) *
296 dwc2_max_desc_num(qh));
297}
298
299/**
300 * dwc2_hcd_qh_init_ddma() - Initializes a QH structure's Descriptor DMA
301 * related members
302 *
303 * @hsotg: The HCD state structure for the DWC OTG controller
304 * @qh: The QH to init
305 * @mem_flags: Indicates the type of memory allocation
306 *
307 * Return: 0 if successful, negative error code otherwise
308 *
309 * Allocates memory for the descriptor list. For the first periodic QH,
310 * allocates memory for the FrameList and enables periodic scheduling.
311 */
312int dwc2_hcd_qh_init_ddma(struct dwc2_hsotg *hsotg, struct dwc2_qh *qh,
313 gfp_t mem_flags)
314{
315 int retval;
316
317 if (qh->do_split) {
318 dev_err(hsotg->dev,
319 "SPLIT Transfers are not supported in Descriptor DMA mode.\n");
320 retval = -EINVAL;
321 goto err0;
322 }
323
324 retval = dwc2_desc_list_alloc(hsotg, qh, mem_flags);
325 if (retval)
326 goto err0;
327
328 if (qh->ep_type == USB_ENDPOINT_XFER_ISOC ||
329 qh->ep_type == USB_ENDPOINT_XFER_INT) {
330 if (!hsotg->frame_list) {
331 retval = dwc2_frame_list_alloc(hsotg, mem_flags);
332 if (retval)
333 goto err1;
334 /* Enable periodic schedule on first periodic QH */
335 dwc2_per_sched_enable(hsotg, HCFG_FRLISTEN_64);
336 }
337 }
338
339 qh->ntd = 0;
340 return 0;
341
342err1:
343 dwc2_desc_list_free(hsotg, qh);
344err0:
345 return retval;
346}
347
348/**
349 * dwc2_hcd_qh_free_ddma() - Frees a QH structure's Descriptor DMA related
350 * members
351 *
352 * @hsotg: The HCD state structure for the DWC OTG controller
353 * @qh: The QH to free
354 *
355 * Frees descriptor list memory associated with the QH. If QH is periodic and
356 * the last, frees FrameList memory and disables periodic scheduling.
357 */
358void dwc2_hcd_qh_free_ddma(struct dwc2_hsotg *hsotg, struct dwc2_qh *qh)
359{
360 unsigned long flags;
361
362 dwc2_desc_list_free(hsotg, qh);
363
364 /*
365 * Channel still assigned due to some reasons.
366 * Seen on Isoc URB dequeue. Channel halted but no subsequent
367 * ChHalted interrupt to release the channel. Afterwards
368 * when it comes here from endpoint disable routine
369 * channel remains assigned.
370 */
371 spin_lock_irqsave(&hsotg->lock, flags);
372 if (qh->channel)
373 dwc2_release_channel_ddma(hsotg, qh);
374 spin_unlock_irqrestore(&hsotg->lock, flags);
375
376 if ((qh->ep_type == USB_ENDPOINT_XFER_ISOC ||
377 qh->ep_type == USB_ENDPOINT_XFER_INT) &&
378 (hsotg->params.uframe_sched ||
379 !hsotg->periodic_channels) && hsotg->frame_list) {
380 dwc2_per_sched_disable(hsotg);
381 dwc2_frame_list_free(hsotg);
382 }
383}
384
385static u8 dwc2_frame_to_desc_idx(struct dwc2_qh *qh, u16 frame_idx)
386{
387 if (qh->dev_speed == USB_SPEED_HIGH)
388 /* Descriptor set (8 descriptors) index which is 8-aligned */
389 return (frame_idx & ((MAX_DMA_DESC_NUM_HS_ISOC / 8) - 1)) * 8;
390 else
391 return frame_idx & (MAX_DMA_DESC_NUM_GENERIC - 1);
392}
393
394/*
395 * Determine starting frame for Isochronous transfer.
396 * Few frames skipped to prevent race condition with HC.
397 */
398static u16 dwc2_calc_starting_frame(struct dwc2_hsotg *hsotg,
399 struct dwc2_qh *qh, u16 *skip_frames)
400{
401 u16 frame;
402
403 hsotg->frame_number = dwc2_hcd_get_frame_number(hsotg);
404
405 /*
406 * next_active_frame is always frame number (not uFrame) both in FS
407 * and HS!
408 */
409
410 /*
411 * skip_frames is used to limit activated descriptors number
412 * to avoid the situation when HC services the last activated
413 * descriptor firstly.
414 * Example for FS:
415 * Current frame is 1, scheduled frame is 3. Since HC always fetches
416 * the descriptor corresponding to curr_frame+1, the descriptor
417 * corresponding to frame 2 will be fetched. If the number of
418 * descriptors is max=64 (or greather) the list will be fully programmed
419 * with Active descriptors and it is possible case (rare) that the
420 * latest descriptor(considering rollback) corresponding to frame 2 will
421 * be serviced first. HS case is more probable because, in fact, up to
422 * 11 uframes (16 in the code) may be skipped.
423 */
424 if (qh->dev_speed == USB_SPEED_HIGH) {
425 /*
426 * Consider uframe counter also, to start xfer asap. If half of
427 * the frame elapsed skip 2 frames otherwise just 1 frame.
428 * Starting descriptor index must be 8-aligned, so if the
429 * current frame is near to complete the next one is skipped as
430 * well.
431 */
432 if (dwc2_micro_frame_num(hsotg->frame_number) >= 5) {
433 *skip_frames = 2 * 8;
434 frame = dwc2_frame_num_inc(hsotg->frame_number,
435 *skip_frames);
436 } else {
437 *skip_frames = 1 * 8;
438 frame = dwc2_frame_num_inc(hsotg->frame_number,
439 *skip_frames);
440 }
441
442 frame = dwc2_full_frame_num(frame);
443 } else {
444 /*
445 * Two frames are skipped for FS - the current and the next.
446 * But for descriptor programming, 1 frame (descriptor) is
447 * enough, see example above.
448 */
449 *skip_frames = 1;
450 frame = dwc2_frame_num_inc(hsotg->frame_number, 2);
451 }
452
453 return frame;
454}
455
456/*
457 * Calculate initial descriptor index for isochronous transfer based on
458 * scheduled frame
459 */
460static u16 dwc2_recalc_initial_desc_idx(struct dwc2_hsotg *hsotg,
461 struct dwc2_qh *qh)
462{
463 u16 frame, fr_idx, fr_idx_tmp, skip_frames;
464
465 /*
466 * With current ISOC processing algorithm the channel is being released
467 * when no more QTDs in the list (qh->ntd == 0). Thus this function is
468 * called only when qh->ntd == 0 and qh->channel == 0.
469 *
470 * So qh->channel != NULL branch is not used and just not removed from
471 * the source file. It is required for another possible approach which
472 * is, do not disable and release the channel when ISOC session
473 * completed, just move QH to inactive schedule until new QTD arrives.
474 * On new QTD, the QH moved back to 'ready' schedule, starting frame and
475 * therefore starting desc_index are recalculated. In this case channel
476 * is released only on ep_disable.
477 */
478
479 /*
480 * Calculate starting descriptor index. For INTERRUPT endpoint it is
481 * always 0.
482 */
483 if (qh->channel) {
484 frame = dwc2_calc_starting_frame(hsotg, qh, &skip_frames);
485 /*
486 * Calculate initial descriptor index based on FrameList current
487 * bitmap and servicing period
488 */
489 fr_idx_tmp = dwc2_frame_list_idx(frame);
490 fr_idx = (FRLISTEN_64_SIZE +
491 dwc2_frame_list_idx(qh->next_active_frame) -
492 fr_idx_tmp) % dwc2_frame_incr_val(qh);
493 fr_idx = (fr_idx + fr_idx_tmp) % FRLISTEN_64_SIZE;
494 } else {
495 qh->next_active_frame = dwc2_calc_starting_frame(hsotg, qh,
496 &skip_frames);
497 fr_idx = dwc2_frame_list_idx(qh->next_active_frame);
498 }
499
500 qh->td_first = qh->td_last = dwc2_frame_to_desc_idx(qh, fr_idx);
501
502 return skip_frames;
503}
504
505#define ISOC_URB_GIVEBACK_ASAP
506
507#define MAX_ISOC_XFER_SIZE_FS 1023
508#define MAX_ISOC_XFER_SIZE_HS 3072
509#define DESCNUM_THRESHOLD 4
510
511static void dwc2_fill_host_isoc_dma_desc(struct dwc2_hsotg *hsotg,
512 struct dwc2_qtd *qtd,
513 struct dwc2_qh *qh, u32 max_xfer_size,
514 u16 idx)
515{
516 struct dwc2_dma_desc *dma_desc = &qh->desc_list[idx];
517 struct dwc2_hcd_iso_packet_desc *frame_desc;
518
519 memset(dma_desc, 0, sizeof(*dma_desc));
520 frame_desc = &qtd->urb->iso_descs[qtd->isoc_frame_index_last];
521
522 if (frame_desc->length > max_xfer_size)
523 qh->n_bytes[idx] = max_xfer_size;
524 else
525 qh->n_bytes[idx] = frame_desc->length;
526
527 dma_desc->buf = (u32)(qtd->urb->dma + frame_desc->offset);
528 dma_desc->status = qh->n_bytes[idx] << HOST_DMA_ISOC_NBYTES_SHIFT &
529 HOST_DMA_ISOC_NBYTES_MASK;
530
531 /* Set active bit */
532 dma_desc->status |= HOST_DMA_A;
533
534 qh->ntd++;
535 qtd->isoc_frame_index_last++;
536
537#ifdef ISOC_URB_GIVEBACK_ASAP
538 /* Set IOC for each descriptor corresponding to last frame of URB */
539 if (qtd->isoc_frame_index_last == qtd->urb->packet_count)
540 dma_desc->status |= HOST_DMA_IOC;
541#endif
542
543 dma_sync_single_for_device(hsotg->dev,
544 qh->desc_list_dma +
545 (idx * sizeof(struct dwc2_dma_desc)),
546 sizeof(struct dwc2_dma_desc),
547 DMA_TO_DEVICE);
548}
549
550static void dwc2_init_isoc_dma_desc(struct dwc2_hsotg *hsotg,
551 struct dwc2_qh *qh, u16 skip_frames)
552{
553 struct dwc2_qtd *qtd;
554 u32 max_xfer_size;
555 u16 idx, inc, n_desc = 0, ntd_max = 0;
556 u16 cur_idx;
557 u16 next_idx;
558
559 idx = qh->td_last;
560 inc = qh->host_interval;
561 hsotg->frame_number = dwc2_hcd_get_frame_number(hsotg);
562 cur_idx = idx;
563 next_idx = dwc2_desclist_idx_inc(qh->td_last, inc, qh->dev_speed);
564
565 /*
566 * Ensure current frame number didn't overstep last scheduled
567 * descriptor. If it happens, the only way to recover is to move
568 * qh->td_last to current frame number + 1.
569 * So that next isoc descriptor will be scheduled on frame number + 1
570 * and not on a past frame.
571 */
572 if (dwc2_frame_idx_num_gt(cur_idx, next_idx) || (cur_idx == next_idx)) {
573 if (inc < 32) {
574 dev_vdbg(hsotg->dev,
575 "current frame number overstep last descriptor\n");
576 qh->td_last = dwc2_desclist_idx_inc(cur_idx, inc,
577 qh->dev_speed);
578 idx = qh->td_last;
579 }
580 }
581
582 if (qh->host_interval) {
583 ntd_max = (dwc2_max_desc_num(qh) + qh->host_interval - 1) /
584 qh->host_interval;
585 if (skip_frames && !qh->channel)
586 ntd_max -= skip_frames / qh->host_interval;
587 }
588
589 max_xfer_size = qh->dev_speed == USB_SPEED_HIGH ?
590 MAX_ISOC_XFER_SIZE_HS : MAX_ISOC_XFER_SIZE_FS;
591
592 list_for_each_entry(qtd, &qh->qtd_list, qtd_list_entry) {
593 if (qtd->in_process &&
594 qtd->isoc_frame_index_last ==
595 qtd->urb->packet_count)
596 continue;
597
598 qtd->isoc_td_first = idx;
599 while (qh->ntd < ntd_max && qtd->isoc_frame_index_last <
600 qtd->urb->packet_count) {
601 dwc2_fill_host_isoc_dma_desc(hsotg, qtd, qh,
602 max_xfer_size, idx);
603 idx = dwc2_desclist_idx_inc(idx, inc, qh->dev_speed);
604 n_desc++;
605 }
606 qtd->isoc_td_last = idx;
607 qtd->in_process = 1;
608 }
609
610 qh->td_last = idx;
611
612#ifdef ISOC_URB_GIVEBACK_ASAP
613 /* Set IOC for last descriptor if descriptor list is full */
614 if (qh->ntd == ntd_max) {
615 idx = dwc2_desclist_idx_dec(qh->td_last, inc, qh->dev_speed);
616 qh->desc_list[idx].status |= HOST_DMA_IOC;
617 dma_sync_single_for_device(hsotg->dev,
618 qh->desc_list_dma + (idx *
619 sizeof(struct dwc2_dma_desc)),
620 sizeof(struct dwc2_dma_desc),
621 DMA_TO_DEVICE);
622 }
623#else
624 /*
625 * Set IOC bit only for one descriptor. Always try to be ahead of HW
626 * processing, i.e. on IOC generation driver activates next descriptor
627 * but core continues to process descriptors following the one with IOC
628 * set.
629 */
630
631 if (n_desc > DESCNUM_THRESHOLD)
632 /*
633 * Move IOC "up". Required even if there is only one QTD
634 * in the list, because QTDs might continue to be queued,
635 * but during the activation it was only one queued.
636 * Actually more than one QTD might be in the list if this
637 * function called from XferCompletion - QTDs was queued during
638 * HW processing of the previous descriptor chunk.
639 */
640 idx = dwc2_desclist_idx_dec(idx, inc * ((qh->ntd + 1) / 2),
641 qh->dev_speed);
642 else
643 /*
644 * Set the IOC for the latest descriptor if either number of
645 * descriptors is not greater than threshold or no more new
646 * descriptors activated
647 */
648 idx = dwc2_desclist_idx_dec(qh->td_last, inc, qh->dev_speed);
649
650 qh->desc_list[idx].status |= HOST_DMA_IOC;
651 dma_sync_single_for_device(hsotg->dev,
652 qh->desc_list_dma +
653 (idx * sizeof(struct dwc2_dma_desc)),
654 sizeof(struct dwc2_dma_desc),
655 DMA_TO_DEVICE);
656#endif
657}
658
659static void dwc2_fill_host_dma_desc(struct dwc2_hsotg *hsotg,
660 struct dwc2_host_chan *chan,
661 struct dwc2_qtd *qtd, struct dwc2_qh *qh,
662 int n_desc)
663{
664 struct dwc2_dma_desc *dma_desc = &qh->desc_list[n_desc];
665 int len = chan->xfer_len;
666
667 if (len > HOST_DMA_NBYTES_LIMIT - (chan->max_packet - 1))
668 len = HOST_DMA_NBYTES_LIMIT - (chan->max_packet - 1);
669
670 if (chan->ep_is_in) {
671 int num_packets;
672
673 if (len > 0 && chan->max_packet)
674 num_packets = (len + chan->max_packet - 1)
675 / chan->max_packet;
676 else
677 /* Need 1 packet for transfer length of 0 */
678 num_packets = 1;
679
680 /* Always program an integral # of packets for IN transfers */
681 len = num_packets * chan->max_packet;
682 }
683
684 dma_desc->status = len << HOST_DMA_NBYTES_SHIFT & HOST_DMA_NBYTES_MASK;
685 qh->n_bytes[n_desc] = len;
686
687 if (qh->ep_type == USB_ENDPOINT_XFER_CONTROL &&
688 qtd->control_phase == DWC2_CONTROL_SETUP)
689 dma_desc->status |= HOST_DMA_SUP;
690
691 dma_desc->buf = (u32)chan->xfer_dma;
692
693 dma_sync_single_for_device(hsotg->dev,
694 qh->desc_list_dma +
695 (n_desc * sizeof(struct dwc2_dma_desc)),
696 sizeof(struct dwc2_dma_desc),
697 DMA_TO_DEVICE);
698
699 /*
700 * Last (or only) descriptor of IN transfer with actual size less
701 * than MaxPacket
702 */
703 if (len > chan->xfer_len) {
704 chan->xfer_len = 0;
705 } else {
706 chan->xfer_dma += len;
707 chan->xfer_len -= len;
708 }
709}
710
711static void dwc2_init_non_isoc_dma_desc(struct dwc2_hsotg *hsotg,
712 struct dwc2_qh *qh)
713{
714 struct dwc2_qtd *qtd;
715 struct dwc2_host_chan *chan = qh->channel;
716 int n_desc = 0;
717
718 dev_vdbg(hsotg->dev, "%s(): qh=%p dma=%08lx len=%d\n", __func__, qh,
719 (unsigned long)chan->xfer_dma, chan->xfer_len);
720
721 /*
722 * Start with chan->xfer_dma initialized in assign_and_init_hc(), then
723 * if SG transfer consists of multiple URBs, this pointer is re-assigned
724 * to the buffer of the currently processed QTD. For non-SG request
725 * there is always one QTD active.
726 */
727
728 list_for_each_entry(qtd, &qh->qtd_list, qtd_list_entry) {
729 dev_vdbg(hsotg->dev, "qtd=%p\n", qtd);
730
731 if (n_desc) {
732 /* SG request - more than 1 QTD */
733 chan->xfer_dma = qtd->urb->dma +
734 qtd->urb->actual_length;
735 chan->xfer_len = qtd->urb->length -
736 qtd->urb->actual_length;
737 dev_vdbg(hsotg->dev, "buf=%08lx len=%d\n",
738 (unsigned long)chan->xfer_dma, chan->xfer_len);
739 }
740
741 qtd->n_desc = 0;
742 do {
743 if (n_desc > 1) {
744 qh->desc_list[n_desc - 1].status |= HOST_DMA_A;
745 dev_vdbg(hsotg->dev,
746 "set A bit in desc %d (%p)\n",
747 n_desc - 1,
748 &qh->desc_list[n_desc - 1]);
749 dma_sync_single_for_device(hsotg->dev,
750 qh->desc_list_dma +
751 ((n_desc - 1) *
752 sizeof(struct dwc2_dma_desc)),
753 sizeof(struct dwc2_dma_desc),
754 DMA_TO_DEVICE);
755 }
756 dwc2_fill_host_dma_desc(hsotg, chan, qtd, qh, n_desc);
757 dev_vdbg(hsotg->dev,
758 "desc %d (%p) buf=%08x status=%08x\n",
759 n_desc, &qh->desc_list[n_desc],
760 qh->desc_list[n_desc].buf,
761 qh->desc_list[n_desc].status);
762 qtd->n_desc++;
763 n_desc++;
764 } while (chan->xfer_len > 0 &&
765 n_desc != MAX_DMA_DESC_NUM_GENERIC);
766
767 dev_vdbg(hsotg->dev, "n_desc=%d\n", n_desc);
768 qtd->in_process = 1;
769 if (qh->ep_type == USB_ENDPOINT_XFER_CONTROL)
770 break;
771 if (n_desc == MAX_DMA_DESC_NUM_GENERIC)
772 break;
773 }
774
775 if (n_desc) {
776 qh->desc_list[n_desc - 1].status |=
777 HOST_DMA_IOC | HOST_DMA_EOL | HOST_DMA_A;
778 dev_vdbg(hsotg->dev, "set IOC/EOL/A bits in desc %d (%p)\n",
779 n_desc - 1, &qh->desc_list[n_desc - 1]);
780 dma_sync_single_for_device(hsotg->dev,
781 qh->desc_list_dma + (n_desc - 1) *
782 sizeof(struct dwc2_dma_desc),
783 sizeof(struct dwc2_dma_desc),
784 DMA_TO_DEVICE);
785 if (n_desc > 1) {
786 qh->desc_list[0].status |= HOST_DMA_A;
787 dev_vdbg(hsotg->dev, "set A bit in desc 0 (%p)\n",
788 &qh->desc_list[0]);
789 dma_sync_single_for_device(hsotg->dev,
790 qh->desc_list_dma,
791 sizeof(struct dwc2_dma_desc),
792 DMA_TO_DEVICE);
793 }
794 chan->ntd = n_desc;
795 }
796}
797
798/**
799 * dwc2_hcd_start_xfer_ddma() - Starts a transfer in Descriptor DMA mode
800 *
801 * @hsotg: The HCD state structure for the DWC OTG controller
802 * @qh: The QH to init
803 *
804 * Return: 0 if successful, negative error code otherwise
805 *
806 * For Control and Bulk endpoints, initializes descriptor list and starts the
807 * transfer. For Interrupt and Isochronous endpoints, initializes descriptor
808 * list then updates FrameList, marking appropriate entries as active.
809 *
810 * For Isochronous endpoints the starting descriptor index is calculated based
811 * on the scheduled frame, but only on the first transfer descriptor within a
812 * session. Then the transfer is started via enabling the channel.
813 *
814 * For Isochronous endpoints the channel is not halted on XferComplete
815 * interrupt so remains assigned to the endpoint(QH) until session is done.
816 */
817void dwc2_hcd_start_xfer_ddma(struct dwc2_hsotg *hsotg, struct dwc2_qh *qh)
818{
819 /* Channel is already assigned */
820 struct dwc2_host_chan *chan = qh->channel;
821 u16 skip_frames = 0;
822
823 switch (chan->ep_type) {
824 case USB_ENDPOINT_XFER_CONTROL:
825 case USB_ENDPOINT_XFER_BULK:
826 dwc2_init_non_isoc_dma_desc(hsotg, qh);
827 dwc2_hc_start_transfer_ddma(hsotg, chan);
828 break;
829 case USB_ENDPOINT_XFER_INT:
830 dwc2_init_non_isoc_dma_desc(hsotg, qh);
831 dwc2_update_frame_list(hsotg, qh, 1);
832 dwc2_hc_start_transfer_ddma(hsotg, chan);
833 break;
834 case USB_ENDPOINT_XFER_ISOC:
835 if (!qh->ntd)
836 skip_frames = dwc2_recalc_initial_desc_idx(hsotg, qh);
837 dwc2_init_isoc_dma_desc(hsotg, qh, skip_frames);
838
839 if (!chan->xfer_started) {
840 dwc2_update_frame_list(hsotg, qh, 1);
841
842 /*
843 * Always set to max, instead of actual size. Otherwise
844 * ntd will be changed with channel being enabled. Not
845 * recommended.
846 */
847 chan->ntd = dwc2_max_desc_num(qh);
848
849 /* Enable channel only once for ISOC */
850 dwc2_hc_start_transfer_ddma(hsotg, chan);
851 }
852
853 break;
854 default:
855 break;
856 }
857}
858
859#define DWC2_CMPL_DONE 1
860#define DWC2_CMPL_STOP 2
861
862static int dwc2_cmpl_host_isoc_dma_desc(struct dwc2_hsotg *hsotg,
863 struct dwc2_host_chan *chan,
864 struct dwc2_qtd *qtd,
865 struct dwc2_qh *qh, u16 idx)
866{
867 struct dwc2_dma_desc *dma_desc;
868 struct dwc2_hcd_iso_packet_desc *frame_desc;
869 u16 frame_desc_idx;
870 struct urb *usb_urb;
871 u16 remain = 0;
872 int rc = 0;
873
874 if (!qtd->urb)
875 return -EINVAL;
876
877 usb_urb = qtd->urb->priv;
878
879 dma_sync_single_for_cpu(hsotg->dev, qh->desc_list_dma + (idx *
880 sizeof(struct dwc2_dma_desc)),
881 sizeof(struct dwc2_dma_desc),
882 DMA_FROM_DEVICE);
883
884 dma_desc = &qh->desc_list[idx];
885 frame_desc_idx = (idx - qtd->isoc_td_first) & (usb_urb->number_of_packets - 1);
886
887 frame_desc = &qtd->urb->iso_descs[frame_desc_idx];
888 if (idx == qtd->isoc_td_first)
889 usb_urb->start_frame = dwc2_hcd_get_frame_number(hsotg);
890 dma_desc->buf = (u32)(qtd->urb->dma + frame_desc->offset);
891 if (chan->ep_is_in)
892 remain = (dma_desc->status & HOST_DMA_ISOC_NBYTES_MASK) >>
893 HOST_DMA_ISOC_NBYTES_SHIFT;
894
895 if ((dma_desc->status & HOST_DMA_STS_MASK) == HOST_DMA_STS_PKTERR) {
896 /*
897 * XactError, or unable to complete all the transactions
898 * in the scheduled micro-frame/frame, both indicated by
899 * HOST_DMA_STS_PKTERR
900 */
901 qtd->urb->error_count++;
902 frame_desc->actual_length = qh->n_bytes[idx] - remain;
903 frame_desc->status = -EPROTO;
904 } else {
905 /* Success */
906 frame_desc->actual_length = qh->n_bytes[idx] - remain;
907 frame_desc->status = 0;
908 }
909
910 if (++qtd->isoc_frame_index == usb_urb->number_of_packets) {
911 /*
912 * urb->status is not used for isoc transfers here. The
913 * individual frame_desc status are used instead.
914 */
915 dwc2_host_complete(hsotg, qtd, 0);
916 dwc2_hcd_qtd_unlink_and_free(hsotg, qtd, qh);
917
918 /*
919 * This check is necessary because urb_dequeue can be called
920 * from urb complete callback (sound driver for example). All
921 * pending URBs are dequeued there, so no need for further
922 * processing.
923 */
924 if (chan->halt_status == DWC2_HC_XFER_URB_DEQUEUE)
925 return -1;
926 rc = DWC2_CMPL_DONE;
927 }
928
929 qh->ntd--;
930
931 /* Stop if IOC requested descriptor reached */
932 if (dma_desc->status & HOST_DMA_IOC)
933 rc = DWC2_CMPL_STOP;
934
935 return rc;
936}
937
938static void dwc2_complete_isoc_xfer_ddma(struct dwc2_hsotg *hsotg,
939 struct dwc2_host_chan *chan,
940 enum dwc2_halt_status halt_status)
941{
942 struct dwc2_hcd_iso_packet_desc *frame_desc;
943 struct dwc2_qtd *qtd, *qtd_tmp;
944 struct dwc2_qh *qh;
945 u16 idx;
946 int rc;
947
948 qh = chan->qh;
949 idx = qh->td_first;
950
951 if (chan->halt_status == DWC2_HC_XFER_URB_DEQUEUE) {
952 list_for_each_entry(qtd, &qh->qtd_list, qtd_list_entry)
953 qtd->in_process = 0;
954 return;
955 }
956
957 if (halt_status == DWC2_HC_XFER_AHB_ERR ||
958 halt_status == DWC2_HC_XFER_BABBLE_ERR) {
959 /*
960 * Channel is halted in these error cases, considered as serious
961 * issues.
962 * Complete all URBs marking all frames as failed, irrespective
963 * whether some of the descriptors (frames) succeeded or not.
964 * Pass error code to completion routine as well, to update
965 * urb->status, some of class drivers might use it to stop
966 * queing transfer requests.
967 */
968 int err = halt_status == DWC2_HC_XFER_AHB_ERR ?
969 -EIO : -EOVERFLOW;
970
971 list_for_each_entry_safe(qtd, qtd_tmp, &qh->qtd_list,
972 qtd_list_entry) {
973 if (qtd->urb) {
974 for (idx = 0; idx < qtd->urb->packet_count;
975 idx++) {
976 frame_desc = &qtd->urb->iso_descs[idx];
977 frame_desc->status = err;
978 }
979
980 dwc2_host_complete(hsotg, qtd, err);
981 }
982
983 dwc2_hcd_qtd_unlink_and_free(hsotg, qtd, qh);
984 }
985
986 return;
987 }
988
989 list_for_each_entry_safe(qtd, qtd_tmp, &qh->qtd_list, qtd_list_entry) {
990 if (!qtd->in_process)
991 break;
992
993 /*
994 * Ensure idx corresponds to descriptor where first urb of this
995 * qtd was added. In fact, during isoc desc init, dwc2 may skip
996 * an index if current frame number is already over this index.
997 */
998 if (idx != qtd->isoc_td_first) {
999 dev_vdbg(hsotg->dev,
1000 "try to complete %d instead of %d\n",
1001 idx, qtd->isoc_td_first);
1002 idx = qtd->isoc_td_first;
1003 }
1004
1005 do {
1006 struct dwc2_qtd *qtd_next;
1007 u16 cur_idx;
1008
1009 rc = dwc2_cmpl_host_isoc_dma_desc(hsotg, chan, qtd, qh,
1010 idx);
1011 if (rc < 0)
1012 return;
1013 idx = dwc2_desclist_idx_inc(idx, qh->host_interval,
1014 chan->speed);
1015 if (rc == 0)
1016 continue;
1017
1018 if (rc == DWC2_CMPL_DONE || rc == DWC2_CMPL_STOP)
1019 goto stop_scan;
1020
1021 /* rc == DWC2_CMPL_STOP */
1022
1023 if (qh->host_interval >= 32)
1024 goto stop_scan;
1025
1026 qh->td_first = idx;
1027 cur_idx = dwc2_frame_list_idx(hsotg->frame_number);
1028 qtd_next = list_first_entry(&qh->qtd_list,
1029 struct dwc2_qtd,
1030 qtd_list_entry);
1031 if (dwc2_frame_idx_num_gt(cur_idx,
1032 qtd_next->isoc_td_last))
1033 break;
1034
1035 goto stop_scan;
1036
1037 } while (idx != qh->td_first);
1038 }
1039
1040stop_scan:
1041 qh->td_first = idx;
1042}
1043
1044static int dwc2_update_non_isoc_urb_state_ddma(struct dwc2_hsotg *hsotg,
1045 struct dwc2_host_chan *chan,
1046 struct dwc2_qtd *qtd,
1047 struct dwc2_dma_desc *dma_desc,
1048 enum dwc2_halt_status halt_status,
1049 u32 n_bytes, int *xfer_done)
1050{
1051 struct dwc2_hcd_urb *urb = qtd->urb;
1052 u16 remain = 0;
1053
1054 if (chan->ep_is_in)
1055 remain = (dma_desc->status & HOST_DMA_NBYTES_MASK) >>
1056 HOST_DMA_NBYTES_SHIFT;
1057
1058 dev_vdbg(hsotg->dev, "remain=%d dwc2_urb=%p\n", remain, urb);
1059
1060 if (halt_status == DWC2_HC_XFER_AHB_ERR) {
1061 dev_err(hsotg->dev, "EIO\n");
1062 urb->status = -EIO;
1063 return 1;
1064 }
1065
1066 if ((dma_desc->status & HOST_DMA_STS_MASK) == HOST_DMA_STS_PKTERR) {
1067 switch (halt_status) {
1068 case DWC2_HC_XFER_STALL:
1069 dev_vdbg(hsotg->dev, "Stall\n");
1070 urb->status = -EPIPE;
1071 break;
1072 case DWC2_HC_XFER_BABBLE_ERR:
1073 dev_err(hsotg->dev, "Babble\n");
1074 urb->status = -EOVERFLOW;
1075 break;
1076 case DWC2_HC_XFER_XACT_ERR:
1077 dev_err(hsotg->dev, "XactErr\n");
1078 urb->status = -EPROTO;
1079 break;
1080 default:
1081 dev_err(hsotg->dev,
1082 "%s: Unhandled descriptor error status (%d)\n",
1083 __func__, halt_status);
1084 break;
1085 }
1086 return 1;
1087 }
1088
1089 if (dma_desc->status & HOST_DMA_A) {
1090 dev_vdbg(hsotg->dev,
1091 "Active descriptor encountered on channel %d\n",
1092 chan->hc_num);
1093 return 0;
1094 }
1095
1096 if (chan->ep_type == USB_ENDPOINT_XFER_CONTROL) {
1097 if (qtd->control_phase == DWC2_CONTROL_DATA) {
1098 urb->actual_length += n_bytes - remain;
1099 if (remain || urb->actual_length >= urb->length) {
1100 /*
1101 * For Control Data stage do not set urb->status
1102 * to 0, to prevent URB callback. Set it when
1103 * Status phase is done. See below.
1104 */
1105 *xfer_done = 1;
1106 }
1107 } else if (qtd->control_phase == DWC2_CONTROL_STATUS) {
1108 urb->status = 0;
1109 *xfer_done = 1;
1110 }
1111 /* No handling for SETUP stage */
1112 } else {
1113 /* BULK and INTR */
1114 urb->actual_length += n_bytes - remain;
1115 dev_vdbg(hsotg->dev, "length=%d actual=%d\n", urb->length,
1116 urb->actual_length);
1117 if (remain || urb->actual_length >= urb->length) {
1118 urb->status = 0;
1119 *xfer_done = 1;
1120 }
1121 }
1122
1123 return 0;
1124}
1125
1126static int dwc2_process_non_isoc_desc(struct dwc2_hsotg *hsotg,
1127 struct dwc2_host_chan *chan,
1128 int chnum, struct dwc2_qtd *qtd,
1129 int desc_num,
1130 enum dwc2_halt_status halt_status,
1131 int *xfer_done)
1132{
1133 struct dwc2_qh *qh = chan->qh;
1134 struct dwc2_hcd_urb *urb = qtd->urb;
1135 struct dwc2_dma_desc *dma_desc;
1136 u32 n_bytes;
1137 int failed;
1138
1139 dev_vdbg(hsotg->dev, "%s()\n", __func__);
1140
1141 if (!urb)
1142 return -EINVAL;
1143
1144 dma_sync_single_for_cpu(hsotg->dev,
1145 qh->desc_list_dma + (desc_num *
1146 sizeof(struct dwc2_dma_desc)),
1147 sizeof(struct dwc2_dma_desc),
1148 DMA_FROM_DEVICE);
1149
1150 dma_desc = &qh->desc_list[desc_num];
1151 n_bytes = qh->n_bytes[desc_num];
1152 dev_vdbg(hsotg->dev,
1153 "qtd=%p dwc2_urb=%p desc_num=%d desc=%p n_bytes=%d\n",
1154 qtd, urb, desc_num, dma_desc, n_bytes);
1155 failed = dwc2_update_non_isoc_urb_state_ddma(hsotg, chan, qtd, dma_desc,
1156 halt_status, n_bytes,
1157 xfer_done);
1158 if (failed || (*xfer_done && urb->status != -EINPROGRESS)) {
1159 dwc2_host_complete(hsotg, qtd, urb->status);
1160 dwc2_hcd_qtd_unlink_and_free(hsotg, qtd, qh);
1161 dev_vdbg(hsotg->dev, "failed=%1x xfer_done=%1x\n",
1162 failed, *xfer_done);
1163 return failed;
1164 }
1165
1166 if (qh->ep_type == USB_ENDPOINT_XFER_CONTROL) {
1167 switch (qtd->control_phase) {
1168 case DWC2_CONTROL_SETUP:
1169 if (urb->length > 0)
1170 qtd->control_phase = DWC2_CONTROL_DATA;
1171 else
1172 qtd->control_phase = DWC2_CONTROL_STATUS;
1173 dev_vdbg(hsotg->dev,
1174 " Control setup transaction done\n");
1175 break;
1176 case DWC2_CONTROL_DATA:
1177 if (*xfer_done) {
1178 qtd->control_phase = DWC2_CONTROL_STATUS;
1179 dev_vdbg(hsotg->dev,
1180 " Control data transfer done\n");
1181 } else if (desc_num + 1 == qtd->n_desc) {
1182 /*
1183 * Last descriptor for Control data stage which
1184 * is not completed yet
1185 */
1186 dwc2_hcd_save_data_toggle(hsotg, chan, chnum,
1187 qtd);
1188 }
1189 break;
1190 default:
1191 break;
1192 }
1193 }
1194
1195 return 0;
1196}
1197
1198static void dwc2_complete_non_isoc_xfer_ddma(struct dwc2_hsotg *hsotg,
1199 struct dwc2_host_chan *chan,
1200 int chnum,
1201 enum dwc2_halt_status halt_status)
1202{
1203 struct list_head *qtd_item, *qtd_tmp;
1204 struct dwc2_qh *qh = chan->qh;
1205 struct dwc2_qtd *qtd = NULL;
1206 int xfer_done;
1207 int desc_num = 0;
1208
1209 if (chan->halt_status == DWC2_HC_XFER_URB_DEQUEUE) {
1210 list_for_each_entry(qtd, &qh->qtd_list, qtd_list_entry)
1211 qtd->in_process = 0;
1212 return;
1213 }
1214
1215 list_for_each_safe(qtd_item, qtd_tmp, &qh->qtd_list) {
1216 int i;
1217 int qtd_desc_count;
1218
1219 qtd = list_entry(qtd_item, struct dwc2_qtd, qtd_list_entry);
1220 xfer_done = 0;
1221 qtd_desc_count = qtd->n_desc;
1222
1223 for (i = 0; i < qtd_desc_count; i++) {
1224 if (dwc2_process_non_isoc_desc(hsotg, chan, chnum, qtd,
1225 desc_num, halt_status,
1226 &xfer_done)) {
1227 qtd = NULL;
1228 goto stop_scan;
1229 }
1230
1231 desc_num++;
1232 }
1233 }
1234
1235stop_scan:
1236 if (qh->ep_type != USB_ENDPOINT_XFER_CONTROL) {
1237 /*
1238 * Resetting the data toggle for bulk and interrupt endpoints
1239 * in case of stall. See handle_hc_stall_intr().
1240 */
1241 if (halt_status == DWC2_HC_XFER_STALL)
1242 qh->data_toggle = DWC2_HC_PID_DATA0;
1243 else
1244 dwc2_hcd_save_data_toggle(hsotg, chan, chnum, NULL);
1245 }
1246
1247 if (halt_status == DWC2_HC_XFER_COMPLETE) {
1248 if (chan->hcint & HCINTMSK_NYET) {
1249 /*
1250 * Got a NYET on the last transaction of the transfer.
1251 * It means that the endpoint should be in the PING
1252 * state at the beginning of the next transfer.
1253 */
1254 qh->ping_state = 1;
1255 }
1256 }
1257}
1258
1259/**
1260 * dwc2_hcd_complete_xfer_ddma() - Scans the descriptor list, updates URB's
1261 * status and calls completion routine for the URB if it's done. Called from
1262 * interrupt handlers.
1263 *
1264 * @hsotg: The HCD state structure for the DWC OTG controller
1265 * @chan: Host channel the transfer is completed on
1266 * @chnum: Index of Host channel registers
1267 * @halt_status: Reason the channel is being halted or just XferComplete
1268 * for isochronous transfers
1269 *
1270 * Releases the channel to be used by other transfers.
1271 * In case of Isochronous endpoint the channel is not halted until the end of
1272 * the session, i.e. QTD list is empty.
1273 * If periodic channel released the FrameList is updated accordingly.
1274 * Calls transaction selection routines to activate pending transfers.
1275 */
1276void dwc2_hcd_complete_xfer_ddma(struct dwc2_hsotg *hsotg,
1277 struct dwc2_host_chan *chan, int chnum,
1278 enum dwc2_halt_status halt_status)
1279{
1280 struct dwc2_qh *qh = chan->qh;
1281 int continue_isoc_xfer = 0;
1282 enum dwc2_transaction_type tr_type;
1283
1284 if (chan->ep_type == USB_ENDPOINT_XFER_ISOC) {
1285 dwc2_complete_isoc_xfer_ddma(hsotg, chan, halt_status);
1286
1287 /* Release the channel if halted or session completed */
1288 if (halt_status != DWC2_HC_XFER_COMPLETE ||
1289 list_empty(&qh->qtd_list)) {
1290 struct dwc2_qtd *qtd, *qtd_tmp;
1291
1292 /*
1293 * Kill all remainings QTDs since channel has been
1294 * halted.
1295 */
1296 list_for_each_entry_safe(qtd, qtd_tmp,
1297 &qh->qtd_list,
1298 qtd_list_entry) {
1299 dwc2_host_complete(hsotg, qtd,
1300 -ECONNRESET);
1301 dwc2_hcd_qtd_unlink_and_free(hsotg,
1302 qtd, qh);
1303 }
1304
1305 /* Halt the channel if session completed */
1306 if (halt_status == DWC2_HC_XFER_COMPLETE)
1307 dwc2_hc_halt(hsotg, chan, halt_status);
1308 dwc2_release_channel_ddma(hsotg, qh);
1309 dwc2_hcd_qh_unlink(hsotg, qh);
1310 } else {
1311 /* Keep in assigned schedule to continue transfer */
1312 list_move_tail(&qh->qh_list_entry,
1313 &hsotg->periodic_sched_assigned);
1314 /*
1315 * If channel has been halted during giveback of urb
1316 * then prevent any new scheduling.
1317 */
1318 if (!chan->halt_status)
1319 continue_isoc_xfer = 1;
1320 }
1321 /*
1322 * Todo: Consider the case when period exceeds FrameList size.
1323 * Frame Rollover interrupt should be used.
1324 */
1325 } else {
1326 /*
1327 * Scan descriptor list to complete the URB(s), then release
1328 * the channel
1329 */
1330 dwc2_complete_non_isoc_xfer_ddma(hsotg, chan, chnum,
1331 halt_status);
1332 dwc2_release_channel_ddma(hsotg, qh);
1333 dwc2_hcd_qh_unlink(hsotg, qh);
1334
1335 if (!list_empty(&qh->qtd_list)) {
1336 /*
1337 * Add back to inactive non-periodic schedule on normal
1338 * completion
1339 */
1340 dwc2_hcd_qh_add(hsotg, qh);
1341 }
1342 }
1343
1344 tr_type = dwc2_hcd_select_transactions(hsotg);
1345 if (tr_type != DWC2_TRANSACTION_NONE || continue_isoc_xfer) {
1346 if (continue_isoc_xfer) {
1347 if (tr_type == DWC2_TRANSACTION_NONE)
1348 tr_type = DWC2_TRANSACTION_PERIODIC;
1349 else if (tr_type == DWC2_TRANSACTION_NON_PERIODIC)
1350 tr_type = DWC2_TRANSACTION_ALL;
1351 }
1352 dwc2_hcd_queue_transactions(hsotg, tr_type);
1353 }
1354}