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