diff options
Diffstat (limited to 'package/platform/lantiq/ltq-hcd/src/ifxhcd.c')
| -rw-r--r-- | package/platform/lantiq/ltq-hcd/src/ifxhcd.c | 2141 |
1 files changed, 0 insertions, 2141 deletions
diff --git a/package/platform/lantiq/ltq-hcd/src/ifxhcd.c b/package/platform/lantiq/ltq-hcd/src/ifxhcd.c deleted file mode 100644 index be0a91d..0000000 --- a/package/platform/lantiq/ltq-hcd/src/ifxhcd.c +++ /dev/null @@ -1,2141 +0,0 @@ -/***************************************************************************** - ** FILE NAME : ifxhcd.c - ** PROJECT : IFX USB sub-system V3 - ** MODULES : IFX USB sub-system Host and Device driver - ** SRC VERSION : 3.2 - ** DATE : 1/Jan/2011 - ** AUTHOR : Chen, Howard - ** DESCRIPTION : This file contains the structures, constants, and - ** interfaces for the Host Contoller Driver (HCD). - ** - ** The Host Controller Driver (HCD) is responsible for - ** translating requests from the USB Driver into the - ** appropriate actions on the IFXUSB controller. - ** It isolates the USBD from the specifics of the - ** controller by providing an API to the USBD. - ** FUNCTIONS : - ** COMPILER : gcc - ** REFERENCE : Synopsys DWC-OTG Driver 2.7 - ** COPYRIGHT : Copyright (c) 2010 - ** LANTIQ DEUTSCHLAND GMBH, - ** Am Campeon 3, 85579 Neubiberg, Germany - ** - ** This program is free software; you can redistribute it and/or modify - ** it under the terms of the GNU General Public License as published by - ** the Free Software Foundation; either version 2 of the License, or - ** (at your option) any later version. - ** - ** Version Control Section ** - ** $Author$ - ** $Date$ - ** $Revisions$ - ** $Log$ Revision history - *****************************************************************************/ - -/* - * This file contains code fragments from Synopsys HS OTG Linux Software Driver. - * For this code the following notice is applicable: - * - * ========================================================================== - * - * Synopsys HS OTG Linux Software Driver and documentation (hereinafter, - * "Software") is an Unsupported proprietary work of Synopsys, Inc. unless - * otherwise expressly agreed to in writing between Synopsys and you. - * - * The Software IS NOT an item of Licensed Software or Licensed Product under - * any End User Software License Agreement or Agreement for Licensed Product - * with Synopsys or any supplement thereto. You are permitted to use and - * redistribute this Software in source and binary forms, with or without - * modification, provided that redistributions of source code must retain this - * notice. You may not view, use, disclose, copy or distribute this file or - * any information contained herein except pursuant to this license grant from - * Synopsys. If you do not agree with this notice, including the disclaimer - * below, then you are not authorized to use the Software. - * - * THIS SOFTWARE IS BEING DISTRIBUTED BY SYNOPSYS SOLELY ON AN "AS IS" BASIS - * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE - * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE - * ARE HEREBY DISCLAIMED. IN NO EVENT SHALL SYNOPSYS BE LIABLE FOR ANY DIRECT, - * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES - * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR - * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER - * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT - * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY - * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH - * DAMAGE. - * ========================================================================== */ - -/*! - \file ifxhcd.c - \ingroup IFXUSB_DRIVER_V3 - \brief This file contains the implementation of the HCD. In Linux, - the HCD implements the hc_driver API. -*/ - -#include <linux/version.h> -#include "ifxusb_version.h" - -#include <linux/kernel.h> -#include <linux/module.h> -#include <linux/moduleparam.h> -#include <linux/init.h> - -#include <linux/device.h> - -#include <linux/errno.h> -#include <linux/list.h> -#include <linux/interrupt.h> -#include <linux/string.h> - -#include <linux/dma-mapping.h> - - -#include "ifxusb_plat.h" -#include "ifxusb_regs.h" -#include "ifxusb_cif.h" -#include "ifxhcd.h" - -#include <asm/irq.h> - -#ifdef __DEBUG__ - static void dump_urb_info(struct urb *_urb, char* _fn_name); -#if 0 - static void dump_channel_info(ifxhcd_hcd_t *_ifxhcd, - ifxhcd_epqh_t *_epqh); -#endif -#endif - -static void ifxhcd_complete_urb_sub(ifxhcd_urbd_t *_urbd) -{ - ifxhcd_hcd_t *ifxhcd; - struct urb *urb=NULL; - - if (!list_empty(&_urbd->ql)) - { - list_del_init(&_urbd->ql); - _urbd->epqh->urbd_count--; - } - else - IFX_ERROR("%s: urb(%p) not connect to any epqh\n", - __func__,_urbd); - - ifxhcd=_urbd->epqh->ifxhcd; - urb =_urbd->urb; - if(!urb) - IFX_ERROR("%s: invalid urb\n",__func__); - else if(urb->hcpriv) - { - if(urb->hcpriv != _urbd) - IFX_ERROR("%s: invalid" - " urb(%p)->hcpriv(%p) != _urbd(%p)\n", - __func__, - urb, - urb->hcpriv, - _urbd); - #if defined(__UNALIGNED_BUF_ADJ__) - if(_urbd->is_in && -// _urbd->using_aligned_buf && - _urbd->aligned_buf) - memcpy(_urbd->xfer_buff, - _urbd->aligned_buf, - _urbd->xfer_len); - if(_urbd->aligned_buf) - ifxusb_free_buf_h(_urbd->aligned_buf); - #endif - urb->hcpriv = NULL; - #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,32) - urb->status=_urbd->status; - usb_hcd_giveback_urb(ifxhcd_to_syshcd(ifxhcd), urb); - #else - usb_hcd_giveback_urb(ifxhcd_to_syshcd(ifxhcd), urb, - _urbd->status); - #endif - } - kfree(_urbd); -} - -#ifdef __STRICT_ORDER__ - static void ifxhcd_complete_urb_func(unsigned long data) - { - unsigned long flags; - ifxhcd_urbd_t *urbd; - ifxhcd_epqh_t *epqh; - struct list_head *item; - - int count=10; - - epqh=((ifxhcd_epqh_t *)data); - - while (!list_empty(&epqh->release_list) && count) - { - item = epqh->release_list.next; - urbd = list_entry(item, ifxhcd_urbd_t, ql); - if (!urbd) - IFX_ERROR("%s: invalid urbd\n",__func__); - else if (!urbd->epqh) - IFX_ERROR("%s: invalid epqd\n",__func__); - else - { - ifxhcd_epqh_t *epqh2; - epqh2=urbd->epqh; - local_irq_save(flags); - LOCK_URBD_LIST(epqh2); - ifxhcd_complete_urb_sub(urbd); - UNLOCK_URBD_LIST(epqh2); - local_irq_restore (flags); - } - count--; - } - if(!list_empty(&epqh->release_list)) - tasklet_schedule(&epqh->complete_urb_sub); - } - - /*! - \brief Sets the final status of an URB and returns it to the device - driver. Any required cleanup of the URB is performed. - */ - void ifxhcd_complete_urb(ifxhcd_hcd_t *_ifxhcd, - ifxhcd_urbd_t *_urbd, - int _status) - { - unsigned long flags; - - if(!_urbd) - { - IFX_ERROR("%s: invalid urbd\n",__func__); - return; - } - if (!_urbd->epqh) - { - IFX_ERROR("%s: invalid epqh\n",__func__); - return; - } - - local_irq_save(flags); - LOCK_URBD_LIST(_urbd->epqh); - #ifdef __DEBUG__ - if (CHK_DEBUG_LEVEL(DBG_HCDV | DBG_HCD_URB)) - { - IFX_PRINT("%s: ehqh %p _urbd %p, urb %p," - " device %d, ep %d %s/%s, status=%d\n", - __func__,_urbd->epqh, - _urbd,_urbd->urb, - (_urbd->urb)?usb_pipedevice(_urbd->urb->pipe):-1, - (_urbd->urb)?usb_pipeendpoint(_urbd->urb->pipe):-1, - (_urbd->urb)?(usb_pipein(_urbd->urb->pipe) ? "IN" : "OUT"):"--", - (_urbd->is_in) ? "IN" : "OUT", - _status); - if ((_urbd->urb)&& _urbd->epqh->ep_type == IFXUSB_EP_TYPE_ISOC) - { - int i; - for (i = 0; i < _urbd->urb->number_of_packets; i++) - IFX_PRINT(" ISO Desc %d status: %d\n", i, _urbd->urb->iso_frame_desc[i].status); - } - } - #endif - _urbd->status = _status; - - if(_urbd->phase!=URBD_FINISHING) - { - if(_urbd->phase!=URBD_DEQUEUEING && _urbd->phase!=URBD_COMPLETING) - printk(KERN_INFO "Warning: %s() Strange URBD PHASE %d\n",__func__,_urbd->phase); - if(_urbd->urb) - { - if( _urbd->status == 0 - && _urbd->phase==URBD_COMPLETING - && in_irq()) - { - list_move_tail(&_urbd->ql,&_urbd->epqh->release_list); - if(!_urbd->epqh->complete_urb_sub.func) - { - _urbd->epqh->complete_urb_sub.next = NULL; - _urbd->epqh->complete_urb_sub.state = 0; - atomic_set( &_urbd->epqh->complete_urb_sub.count, 0); - _urbd->epqh->complete_urb_sub.func = ifxhcd_complete_urb_func; - _urbd->epqh->complete_urb_sub.data = (unsigned long)_urbd->epqh; - } - tasklet_schedule(&_urbd->epqh->complete_urb_sub); - } - else - { - _urbd->phase=URBD_FINISHING; - ifxhcd_complete_urb_sub(_urbd); - } - UNLOCK_URBD_LIST(_urbd->epqh); - } - else - { - UNLOCK_URBD_LIST(_urbd->epqh); - kfree(_urbd); - } - } - else - { - printk(KERN_INFO "Warning: %s() Double Completing \n",__func__); - UNLOCK_URBD_LIST(_urbd->epqh); - } - - local_irq_restore (flags); - } -#else - static void ifxhcd_complete_urb_func(unsigned long data) - { - unsigned long flags; - ifxhcd_urbd_t *urbd; - - urbd=((ifxhcd_urbd_t *)data); - - // local_irq_save(flags); - if (!urbd) - IFX_ERROR("%s: invalid urbd\n",__func__); - else if (!urbd->epqh) - IFX_ERROR("%s: invalid epqd\n",__func__); - else - { - local_irq_save(flags); - LOCK_URBD_LIST(urbd->epqh); - ifxhcd_complete_urb_sub(urbd); - UNLOCK_URBD_LIST(urbd->epqh); - local_irq_restore (flags); - } - // local_irq_restore (flags); - } - - - /*! - \brief Sets the final status of an URB and returns it to the device driver. Any - required cleanup of the URB is performed. - */ - void ifxhcd_complete_urb(ifxhcd_hcd_t *_ifxhcd, ifxhcd_urbd_t *_urbd, int _status) - { - unsigned long flags; - - if(!_urbd) - { - IFX_ERROR("%s: invalid urbd\n",__func__); - return; - } - if (!_urbd->epqh) - { - IFX_ERROR("%s: invalid epqh\n",__func__); - return; - } - - local_irq_save(flags); - LOCK_URBD_LIST(_urbd->epqh); - #ifdef __DEBUG__ - if (CHK_DEBUG_LEVEL(DBG_HCDV | DBG_HCD_URB)) - { - IFX_PRINT("%s: ehqh %p _urbd %p, urb %p, device %d, ep %d %s/%s, status=%d\n", - __func__,_urbd->epqh, _urbd,_urbd->urb, - (_urbd->urb)?usb_pipedevice(_urbd->urb->pipe):-1, - (_urbd->urb)?usb_pipeendpoint(_urbd->urb->pipe):-1, - (_urbd->urb)?(usb_pipein(_urbd->urb->pipe) ? "IN" : "OUT"):"--", - (_urbd->is_in) ? "IN" : "OUT", - _status); - if ((_urbd->urb)&& _urbd->epqh->ep_type == IFXUSB_EP_TYPE_ISOC) - { - int i; - for (i = 0; i < _urbd->urb->number_of_packets; i++) - IFX_PRINT(" ISO Desc %d status: %d\n", i, _urbd->urb->iso_frame_desc[i].status); - } - } - #endif - _urbd->status = _status; - - if(_urbd->phase!=URBD_FINISHING) - { - if(_urbd->phase!=URBD_DEQUEUEING && _urbd->phase!=URBD_COMPLETING) - printk(KERN_INFO "Warning: %s() Strange URBD PHASE %d\n",__func__,_urbd->phase); - if(_urbd->urb) - { - if( _urbd->status == 0 - && _urbd->phase==URBD_COMPLETING - && in_irq()) - { - if(_urbd->complete_urb_sub.func) - printk(KERN_INFO "Warning: %s() URBD Tasklet is on already\n",__func__); - _urbd->phase=URBD_FINISHING; - _urbd->complete_urb_sub.next = NULL; - _urbd->complete_urb_sub.state = 0; - atomic_set( &_urbd->complete_urb_sub.count, 0); - _urbd->complete_urb_sub.func = ifxhcd_complete_urb_func; - _urbd->complete_urb_sub.data = (unsigned long)_urbd; - tasklet_schedule(&_urbd->complete_urb_sub); - } - else - { - _urbd->phase=URBD_FINISHING; - ifxhcd_complete_urb_sub(_urbd); - } - } - else - kfree(_urbd); - } - else - printk(KERN_INFO "Warning: %s() Double Completing \n",__func__); - UNLOCK_URBD_LIST(_urbd->epqh); - local_irq_restore (flags); - } -#endif - -/*! - \brief Processes all the URBs in a single EPQHs. Completes them with - status and frees the URBD. - */ -static -void kill_all_urbs_in_epqh(ifxhcd_hcd_t *_ifxhcd, ifxhcd_epqh_t *_epqh, int _status) -{ - struct list_head *item; - struct list_head *next; - ifxhcd_urbd_t *urbd; - - if(!_epqh) - return; - - IFX_DEBUGPL(DBG_HCDV, "%s %p\n",__func__,_epqh); - LOCK_URBD_LIST(_epqh); - list_for_each(item, &_epqh->urbd_list) - { - urbd = list_entry(item, ifxhcd_urbd_t, ql); - if( urbd->phase==URBD_IDLE - || urbd->phase==URBD_ACTIVE -// || urbd->phase==URBD_STARTING - ) - urbd->phase=URBD_DEQUEUEING; - } - list_for_each_safe(item, next, &_epqh->urbd_list) - { - urbd = list_entry(item, ifxhcd_urbd_t, ql); - if(urbd->phase==URBD_DEQUEUEING) - { - urbd->urb->status = _status; - urbd->phase = URBD_FINISHING; - ifxhcd_complete_urb_sub(urbd); - } - else if( urbd->phase==URBD_STARTED - || urbd->phase==URBD_STARTING -// || urbd->phase==URBD_ACTIVE - ) - { - if(ifxhcd_hc_halt(&_ifxhcd->core_if, _epqh->hc, HC_XFER_URB_DEQUEUE)) - { - urbd->urb->status = _status; - urbd->phase=URBD_FINISHING; - ifxhcd_complete_urb_sub(urbd); - } - } - else - IFX_ERROR("%s: invalid urb phase:%d \n",__func__,urbd->phase); - } - UNLOCK_URBD_LIST(_epqh); - IFX_DEBUGPL(DBG_HCDV, "%s %p finish\n",__func__,_epqh); -} - - -/*! - \brief Free all EPS in one Processes all the URBs in a single list of EPQHs. Completes them with - -ETIMEDOUT and frees the URBD. - */ -static -void epqh_list_free_1(ifxhcd_hcd_t *_ifxhcd, struct list_head *_epqh_list) -{ - ifxhcd_epqh_t *epqh; - struct list_head *item; - if (!_ifxhcd) - return; - if (!_epqh_list) - return; - - IFX_DEBUGPL(DBG_HCDV, "%s %p\n",__func__,_epqh_list); - - item = _epqh_list->next; - while(item != _epqh_list && item != item->next) - { - epqh = list_entry(item, ifxhcd_epqh_t, ql); - epqh->phase=EPQH_DISABLING; - item = item->next; - kill_all_urbs_in_epqh(_ifxhcd, epqh, -ETIMEDOUT); - #ifdef __STRICT_ORDER__ - if(list_empty(&epqh->urbd_list) && list_empty(&epqh->release_list)) - #else - if(list_empty(&epqh->urbd_list)) - #endif - ifxhcd_epqh_free(epqh); - } - IFX_DEBUGPL(DBG_HCDV, "%s %p finish\n",__func__,_epqh_list); - /* Ensure there are no URBDs or URBs left. */ -} - -static -void epqh_list_free_2(ifxhcd_hcd_t *_ifxhcd, struct list_head *_epqh_list) -{ - ifxhcd_epqh_t *epqh; - struct list_head *item; - struct list_head *next; - if (!_ifxhcd) - return; - if (!_epqh_list) - return; - - IFX_DEBUGPL(DBG_HCDV, "%s %p\n",__func__,_epqh_list); - list_for_each_safe(item, next, _epqh_list) - { - epqh = list_entry(item, ifxhcd_epqh_t, ql); - if(item == item->next) - { - ifxhcd_epqh_free(epqh); - } - else - { - uint32_t count=0x80000; - #ifdef __STRICT_ORDER__ - for(;(!list_empty(&epqh->urbd_list) || !list_empty(&epqh->release_list))&& count> 0; count--) udelay(1); - #else - for(;!list_empty(&epqh->urbd_list) && count> 0; count--) udelay(1); - #endif - if(!count) - IFX_ERROR("%s: unable to clear urbd in epqh \n",__func__); - ifxhcd_epqh_free(epqh); - } - } - IFX_DEBUGPL(DBG_HCDV, "%s %p finish\n",__func__,_epqh_list); - /* Ensure there are no URBDs or URBs left. */ -} - -static -void epqh_list_free_all_sub(unsigned long data) -{ - ifxhcd_hcd_t *ifxhcd; - - ifxhcd=(ifxhcd_hcd_t *)data; - epqh_list_free_1(ifxhcd, &ifxhcd->epqh_list_np ); - epqh_list_free_1(ifxhcd, &ifxhcd->epqh_list_intr); - #ifdef __EN_ISOC__ - epqh_list_free_1(ifxhcd, &ifxhcd->epqh_list_isoc); - #endif - - epqh_list_free_2(ifxhcd, &ifxhcd->epqh_list_np ); - epqh_list_free_2(ifxhcd, &ifxhcd->epqh_list_intr); - #ifdef __EN_ISOC__ - epqh_list_free_2(ifxhcd, &ifxhcd->epqh_list_isoc); - #endif -} - -static -void epqh_list_free_all(ifxhcd_hcd_t *_ifxhcd) -{ - _ifxhcd->tasklet_free_epqh_list.next = NULL; - _ifxhcd->tasklet_free_epqh_list.state = 0; - atomic_set( &_ifxhcd->tasklet_free_epqh_list.count, 0); - _ifxhcd->tasklet_free_epqh_list.func=epqh_list_free_all_sub; - _ifxhcd->tasklet_free_epqh_list.data = (unsigned long)_ifxhcd; - tasklet_schedule(&_ifxhcd->tasklet_free_epqh_list); -} - - -/*! - \brief This function is called to handle the disconnection of host port. - */ -int32_t ifxhcd_disconnect(ifxhcd_hcd_t *_ifxhcd) -{ - IFX_DEBUGPL(DBG_HCDV, "%s(%p)\n", __func__, _ifxhcd); - - _ifxhcd->disconnecting=1; - /* Set status flags for the hub driver. */ - _ifxhcd->flags.b.port_connect_status_change = 1; - _ifxhcd->flags.b.port_connect_status = 0; - - /* - * Shutdown any transfers in process by clearing the Tx FIFO Empty - * interrupt mask and status bits and disabling subsequent host - * channel interrupts. - */ - { - gint_data_t intr = { .d32 = 0 }; - intr.b.nptxfempty = 1; - intr.b.ptxfempty = 1; - intr.b.hcintr = 1; - ifxusb_mreg (&_ifxhcd->core_if.core_global_regs->gintmsk, intr.d32, 0); - ifxusb_mreg (&_ifxhcd->core_if.core_global_regs->gintsts, intr.d32, 0); - } - - /* Respond with an error status to all URBs in the schedule. */ - epqh_list_free_all(_ifxhcd); - - /* Clean up any host channels that were in use. */ - { - int num_channels; - ifxhcd_hc_t *channel; - ifxusb_hc_regs_t *hc_regs; - hcchar_data_t hcchar; - int i; - - num_channels = _ifxhcd->core_if.params.host_channels; - - for (i = 0; i < num_channels; i++) - { - channel = &_ifxhcd->ifxhc[i]; - hc_regs = _ifxhcd->core_if.hc_regs[i]; - hcchar.d32 = ifxusb_rreg(&hc_regs->hcchar); - if (hcchar.b.chen) - printk(KERN_INFO "Warning: %s() HC still enabled\n",__func__); - ifxhcd_hc_cleanup(&_ifxhcd->core_if, channel); - } - } - IFX_DEBUGPL(DBG_HCDV, "%s(%p) finish\n", __func__, _ifxhcd); - return 1; -} - - -/*! - \brief Frees secondary storage associated with the ifxhcd_hcd structure contained - in the struct usb_hcd field. - */ -static void ifxhcd_freeextra(struct usb_hcd *_syshcd) -{ - ifxhcd_hcd_t *ifxhcd = syshcd_to_ifxhcd(_syshcd); - - IFX_DEBUGPL(DBG_HCD, "IFXUSB HCD FREE\n"); - - /* Free memory for EPQH/URBD lists */ - epqh_list_free_all(ifxhcd); - - /* Free memory for the host channels. */ - ifxusb_free_buf_h(ifxhcd->status_buf); - return; -} - -/*! - \brief Initializes the HCD. This function allocates memory for and initializes the - static parts of the usb_hcd and ifxhcd_hcd structures. It also registers the - USB bus with the core and calls the hc_driver->start() function. It returns - a negative error on failure. - */ -int ifxhcd_init(ifxhcd_hcd_t *_ifxhcd) -{ - int retval = 0; - struct usb_hcd *syshcd = NULL; - - IFX_DEBUGPL(DBG_HCD, "IFX USB HCD INIT\n"); - - INIT_EPQH_LIST_ALL(_ifxhcd); - INIT_EPQH_LIST(_ifxhcd); - - init_timer(&_ifxhcd->autoprobe_timer); - init_timer(&_ifxhcd->host_probe_timer); - _ifxhcd->probe_sec = 5; - _ifxhcd->autoprobe_sec = 30; - - _ifxhcd->hc_driver.description = _ifxhcd->core_if.core_name; - _ifxhcd->hc_driver.product_desc = "IFX USB Controller"; - //_ifxhcd->hc_driver.hcd_priv_size = sizeof(ifxhcd_hcd_t); - _ifxhcd->hc_driver.hcd_priv_size = sizeof(unsigned long); - _ifxhcd->hc_driver.irq = ifxhcd_irq; - _ifxhcd->hc_driver.flags = HCD_MEMORY | HCD_USB2; - _ifxhcd->hc_driver.start = ifxhcd_start; - _ifxhcd->hc_driver.stop = ifxhcd_stop; - //_ifxhcd->hc_driver.reset = - //_ifxhcd->hc_driver.suspend = - //_ifxhcd->hc_driver.resume = - _ifxhcd->hc_driver.urb_enqueue = ifxhcd_urb_enqueue; - _ifxhcd->hc_driver.urb_dequeue = ifxhcd_urb_dequeue; - _ifxhcd->hc_driver.endpoint_disable = ifxhcd_endpoint_disable; - _ifxhcd->hc_driver.get_frame_number = ifxhcd_get_frame_number; - _ifxhcd->hc_driver.hub_status_data = ifxhcd_hub_status_data; - _ifxhcd->hc_driver.hub_control = ifxhcd_hub_control; - //_ifxhcd->hc_driver.hub_suspend = - //_ifxhcd->hc_driver.hub_resume = - _ifxhcd->pkt_remaining_reload_hs=PKT_REMAINING_RELOAD_HS; - _ifxhcd->pkt_remaining_reload_fs=PKT_REMAINING_RELOAD_FS; - _ifxhcd->pkt_remaining_reload_ls=PKT_REMAINING_RELOAD_LS; - _ifxhcd->pkt_count_limit_bo =8; - _ifxhcd->pkt_count_limit_bi =8; - - /* Allocate memory for and initialize the base HCD and */ - //syshcd = usb_create_hcd(&_ifxhcd->hc_driver, _ifxhcd->dev, _ifxhcd->dev->bus_id); - syshcd = usb_create_hcd(&_ifxhcd->hc_driver, _ifxhcd->dev, _ifxhcd->core_if.core_name); - - if (syshcd == NULL) - { - retval = -ENOMEM; - goto error1; - } - - syshcd->rsrc_start = (unsigned long)_ifxhcd->core_if.core_global_regs; - syshcd->regs = (void *)_ifxhcd->core_if.core_global_regs; - syshcd->self.otg_port = 0; - - //*((unsigned long *)(&(syshcd->hcd_priv)))=(unsigned long)_ifxhcd; - //*((unsigned long *)(&(syshcd->hcd_priv[0])))=(unsigned long)_ifxhcd; - syshcd->hcd_priv[0]=(unsigned long)_ifxhcd; - _ifxhcd->syshcd=syshcd; - INIT_LIST_HEAD(&_ifxhcd->epqh_list_all ); - INIT_LIST_HEAD(&_ifxhcd->epqh_list_np ); - INIT_LIST_HEAD(&_ifxhcd->epqh_list_intr ); - #ifdef __EN_ISOC__ - INIT_LIST_HEAD(&_ifxhcd->epqh_list_isoc); - #endif - - /* - * Create a host channel descriptor for each host channel implemented - * in the controller. Initialize the channel descriptor array. - */ - { - int num_channels = _ifxhcd->core_if.params.host_channels; - int i; - for (i = 0; i < num_channels; i++) - { - _ifxhcd->ifxhc[i].hc_num = i; - IFX_DEBUGPL(DBG_HCDV, "HCD Added channel #%d\n", i); - } - } - - /* Set device flags indicating whether the HCD supports DMA. */ - if(_ifxhcd->dev->dma_mask) - *(_ifxhcd->dev->dma_mask) = ~0; - _ifxhcd->dev->coherent_dma_mask = ~0; - - /* - * Finish generic HCD initialization and start the HCD. This function - * allocates the DMA buffer pool, registers the USB bus, requests the - * IRQ line, and calls ifxusb_hcd_start method. - */ - retval = usb_add_hcd(syshcd, _ifxhcd->core_if.irq, 0 - |IRQF_DISABLED - |IRQF_SHARED - ); - if (retval < 0) - goto error2; - - /* - * Allocate space for storing data on status transactions. Normally no - * data is sent, but this space acts as a bit bucket. This must be - * done after usb_add_hcd since that function allocates the DMA buffer - * pool. - */ - _ifxhcd->status_buf = ifxusb_alloc_buf_h(IFXHCD_STATUS_BUF_SIZE, 1); - - if (_ifxhcd->status_buf) - { - IFX_DEBUGPL(DBG_HCD, "IFX USB HCD Initialized, bus=%s, usbbus=%d\n", _ifxhcd->core_if.core_name, syshcd->self.busnum); - return 0; - } - IFX_ERROR("%s: status_buf allocation failed\n", __func__); - - /* Error conditions */ - usb_remove_hcd(syshcd); -error2: - ifxhcd_freeextra(syshcd); - usb_put_hcd(syshcd); -error1: - return retval; -} - -/*! - \brief Removes the HCD. - Frees memory and resources associated with the HCD and deregisters the bus. - */ -void ifxhcd_remove(ifxhcd_hcd_t *_ifxhcd) -{ - struct usb_hcd *syshcd = ifxhcd_to_syshcd(_ifxhcd); - - IFX_DEBUGPL(DBG_HCD, "IFX USB HCD REMOVE\n"); - - /* Turn off all interrupts */ - ifxusb_wreg (&_ifxhcd->core_if.core_global_regs->gintmsk, 0); - ifxusb_mreg (&_ifxhcd->core_if.core_global_regs->gahbcfg, 1, 0); - - usb_remove_hcd(syshcd); - ifxhcd_freeextra(syshcd); - usb_put_hcd(syshcd); - - return; -} - - -/* ========================================================================= - * Linux HC Driver Functions - * ========================================================================= */ - -/*! - \brief Initializes the IFXUSB controller and its root hub and prepares it for host - mode operation. Activates the root port. Returns 0 on success and a negative - error code on failure. - Called by USB stack. - */ -int ifxhcd_start(struct usb_hcd *_syshcd) -{ - ifxhcd_hcd_t *ifxhcd = syshcd_to_ifxhcd (_syshcd); - ifxusb_core_if_t *core_if = &ifxhcd->core_if; - struct usb_bus *bus; - - IFX_DEBUGPL(DBG_HCD, "IFX USB HCD START\n"); - - bus = hcd_to_bus(_syshcd); - - /* Initialize the bus state. */ - _syshcd->state = HC_STATE_RUNNING; - - /* Initialize and connect root hub if one is not already attached */ - if (bus->root_hub) - { - IFX_DEBUGPL(DBG_HCD, "IFX USB HCD Has Root Hub\n"); - /* Inform the HUB driver to resume. */ - usb_hcd_resume_root_hub(_syshcd); - } - - ifxhcd->flags.d32 = 0; - - /* Put all channels in the free channel list and clean up channel states.*/ - { - int num_channels = ifxhcd->core_if.params.host_channels; - int i; - for (i = 0; i < num_channels; i++) - { - ifxhcd_hc_t *channel; - channel = &ifxhcd->ifxhc[i]; - ifxhcd_hc_cleanup(&ifxhcd->core_if, channel); - } - } - /* Initialize the USB core for host mode operation. */ - - ifxusb_host_enable_interrupts(core_if); - ifxusb_enable_global_interrupts_h(core_if); - ifxusb_phy_power_on_h (core_if); - - ifxusb_vbus_init(core_if); - - /* Turn on the vbus power. */ - { - hprt0_data_t hprt0; - hprt0.d32 = ifxusb_read_hprt0(core_if); - - IFX_PRINT("Init: Power Port (%d)\n", hprt0.b.prtpwr); - if (hprt0.b.prtpwr == 0 ) - { - hprt0.b.prtpwr = 1; - ifxusb_wreg(core_if->hprt0, hprt0.d32); - ifxusb_vbus_on(core_if); - } - } - return 0; -} - -/*! - \brief Halts the IFXUSB host mode operations in a clean manner. USB transfers are - stopped. - */ - #if defined(__IS_AR10__) -void ifxusb_oc_int_free(int port); - #else -void ifxusb_oc_int_free(void); - #endif - -void ifxhcd_stop(struct usb_hcd *_syshcd) -{ - ifxhcd_hcd_t *ifxhcd = syshcd_to_ifxhcd(_syshcd); - hprt0_data_t hprt0 = { .d32=0 }; - - IFX_DEBUGPL(DBG_HCD, "IFX USB HCD STOP\n"); - - /* Turn off all interrupts. */ - ifxusb_disable_global_interrupts_h(&ifxhcd->core_if ); - ifxusb_host_disable_interrupts(&ifxhcd->core_if ); - - /* - * The root hub should be disconnected before this function is called. - * The disconnect will clear the URBD lists (via ..._hcd_urb_dequeue) - * and the EPQH lists (via ..._hcd_endpoint_disable). - */ - - /* Turn off the vbus power */ - IFX_PRINT("PortPower off\n"); - - ifxusb_vbus_off(&ifxhcd->core_if ); - - - #if defined(__IS_AR10__) - ifxusb_oc_int_free(ifxhcd->core_if.core_no); - #else - ifxusb_oc_int_free(); - #endif - - - ifxusb_vbus_free(&ifxhcd->core_if ); - hprt0.b.prtpwr = 0; - ifxusb_wreg(ifxhcd->core_if.hprt0, hprt0.d32); - return; -} - -/*! - \brief Returns the current frame number - */ -int ifxhcd_get_frame_number(struct usb_hcd *_syshcd) -{ - ifxhcd_hcd_t *ifxhcd = syshcd_to_ifxhcd(_syshcd); - hfnum_data_t hfnum; - - hfnum.d32 = ifxusb_rreg(&ifxhcd->core_if.host_global_regs->hfnum); - - return hfnum.b.frnum; -} - -/*! - \brief Starts processing a USB transfer request specified by a USB Request Block - (URB). mem_flags indicates the type of memory allocation to use while - processing this URB. - */ -int ifxhcd_urb_enqueue( struct usb_hcd *_syshcd, -#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,32) - struct usb_host_endpoint *_sysep, -#endif - struct urb *_urb, - gfp_t _mem_flags) -{ - ifxhcd_hcd_t *ifxhcd = syshcd_to_ifxhcd (_syshcd); - ifxhcd_epqh_t *epqh = NULL; - - #ifdef __DEBUG__ - if (CHK_DEBUG_LEVEL(DBG_HCDV | DBG_HCD_URB)) - dump_urb_info(_urb, "ifxusb_hcd_urb_enqueue"); - #endif //__DEBUG__ - - if (!ifxhcd->flags.b.port_connect_status) /* No longer connected. */ - return -ENODEV; - - #if !defined(__EN_ISOC__) - if(usb_pipetype(_urb->pipe) == PIPE_ISOCHRONOUS) - { - IFX_ERROR("ISOC transfer not supported!!!\n"); - return -ENODEV; - } - #endif - - if(_urb->hcpriv) - { - IFX_WARN("%s() Previous urb->hcpriv exist %p\n",__func__,_urb->hcpriv); - #if 1 - return -ENOSPC; - #endif - } - - epqh=ifxhcd_urbd_create (ifxhcd,_urb); - if (!epqh) - { - IFX_ERROR("IFXUSB HCD URB Enqueue failed creating URBD\n"); - return -ENOSPC; - } - if(epqh->phase==EPQH_DISABLING ) - { - IFX_ERROR("Enqueue to a DISABLING EP!!!\n"); - return -ENODEV; - } - - #ifdef __DYN_SOF_INTR__ - ifxhcd->dyn_sof_count = DYN_SOF_COUNT_DEF; - #endif - //enable_sof(ifxhcd); - { - gint_data_t gintsts; - gintsts.d32=0; - gintsts.b.sofintr = 1; - ifxusb_mreg(&ifxhcd->core_if.core_global_regs->gintmsk, 0,gintsts.d32); - } - - if(epqh->phase==EPQH_IDLE || epqh->phase==EPQH_STDBY ) - { - epqh->phase=EPQH_READY; - #ifdef __EPQD_DESTROY_TIMEOUT__ - del_timer(&epqh->destroy_timer); - #endif - } - select_eps(ifxhcd); - return 0; -} - -/*! - \brief Aborts/cancels a USB transfer request. Always returns 0 to indicate - success. - */ -#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,32) -int ifxhcd_urb_dequeue(struct usb_hcd *_syshcd, struct urb *_urb) -#else -int ifxhcd_urb_dequeue(struct usb_hcd *_syshcd, struct urb *_urb, int status) -#endif -{ - ifxhcd_hcd_t *ifxhcd; - struct usb_host_endpoint *sysep; - ifxhcd_urbd_t *urbd; - ifxhcd_epqh_t *epqh; - - IFX_DEBUGPL(DBG_HCD, "IFXUSB HCD URB Dequeue\n"); - #if !defined(__EN_ISOC__) - if(usb_pipetype(_urb->pipe) == PIPE_ISOCHRONOUS) - return 0; - #endif - - ifxhcd = syshcd_to_ifxhcd(_syshcd); - - urbd = (ifxhcd_urbd_t *) _urb->hcpriv; - if(!urbd) - { - #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,32) - _urb->status=-ETIMEDOUT; - usb_hcd_giveback_urb(_syshcd, _urb); - #else -// usb_hcd_giveback_urb(_syshcd, _urb,-ETIMEDOUT); - usb_hcd_giveback_urb(_syshcd, _urb,status); - #endif - return 0; - } - - sysep = ifxhcd_urb_to_endpoint(_urb); - if(sysep) - { - LOCK_EPQH_LIST_ALL(ifxhcd); - epqh = sysep_to_epqh(ifxhcd,sysep); - UNLOCK_EPQH_LIST_ALL(ifxhcd); - if(epqh!=urbd->epqh) - IFX_ERROR("%s inconsistant epqh %p %p\n",__func__,epqh,urbd->epqh); - } - else - epqh = (ifxhcd_epqh_t *) urbd->epqh; - if(!ifxhcd->flags.b.port_connect_status || !epqh) - { - urbd->phase=URBD_DEQUEUEING; - ifxhcd_complete_urb(ifxhcd, urbd, -ENODEV); - } - else - { - LOCK_URBD_LIST(epqh); - if( urbd->phase==URBD_IDLE - || urbd->phase==URBD_ACTIVE -// || urbd->phase==URBD_STARTING - ) - { - urbd->phase=URBD_DEQUEUEING; - #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,32) - ifxhcd_complete_urb(ifxhcd, urbd, -ETIMEDOUT); - #else - ifxhcd_complete_urb(ifxhcd, urbd, status); - #endif - } - else if( urbd->phase==URBD_STARTED - || urbd->phase==URBD_STARTING -// || urbd->phase==URBD_ACTIVE - ) - { - if(ifxhcd_hc_halt(&ifxhcd->core_if, epqh->hc, HC_XFER_URB_DEQUEUE)) - { - urbd->phase=URBD_DEQUEUEING; - #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,32) - ifxhcd_complete_urb(ifxhcd, urbd, -ETIMEDOUT); - #else - ifxhcd_complete_urb(ifxhcd, urbd, status); - #endif - ifxhcd_epqh_idle(epqh); - } - } - UNLOCK_URBD_LIST(epqh); - } - return 0; -} - - -/*! - \brief Frees resources in the IFXUSB controller related to a given endpoint. Also - clears state in the HCD related to the endpoint. Any URBs for the endpoint - must already be dequeued. - */ -void ifxhcd_endpoint_disable( struct usb_hcd *_syshcd, - struct usb_host_endpoint *_sysep) -{ - ifxhcd_hcd_t *ifxhcd; - ifxhcd_epqh_t *epqh; - - IFX_DEBUGPL(DBG_HCD, "IFXUSB HCD EP DISABLE: _bEndpointAddress=0x%02x, " - "endpoint=%d\n", _sysep->desc.bEndpointAddress, - ifxhcd_ep_addr_to_endpoint(_sysep->desc.bEndpointAddress)); - - ifxhcd = syshcd_to_ifxhcd(_syshcd); - - LOCK_EPQH_LIST_ALL(ifxhcd); - epqh = sysep_to_epqh(ifxhcd,_sysep); - UNLOCK_EPQH_LIST_ALL(ifxhcd); - - if (!epqh) - { - return; - } - else - { - if (epqh->sysep!=_sysep) - { - IFX_ERROR("%s inconsistant sysep %p %p %p\n",__func__,epqh,epqh->sysep,_sysep); - return; - } - - epqh->phase=EPQH_DISABLING; - kill_all_urbs_in_epqh(ifxhcd, epqh, -ETIMEDOUT); - { - uint32_t count=0x80000; - for(;!list_empty(&epqh->urbd_list) && count> 0; count--) udelay(1); - if(!count) - IFX_ERROR("%s: unable to clear urbd in epqh \n",__func__); - } - ifxhcd_epqh_free(epqh); - } - IFX_DEBUGPL(DBG_HCD, "IFXUSB HCD EP DISABLE: done\n"); -} - - -/*! - \brief Handles host mode interrupts for the IFXUSB controller. Returns IRQ_NONE if - there was no interrupt to handle. Returns IRQ_HANDLED if there was a valid - interrupt. - - This function is called by the USB core when an interrupt occurs - */ -irqreturn_t ifxhcd_irq(struct usb_hcd *_syshcd) -{ - ifxhcd_hcd_t *ifxhcd = syshcd_to_ifxhcd (_syshcd); - int32_t retval=0; - - //mask_and_ack_ifx_irq (ifxhcd->core_if.irq); - retval = ifxhcd_handle_intr(ifxhcd); - return IRQ_RETVAL(retval); -} - - - -/*! - \brief Creates Status Change bitmap for the root hub and root port. The bitmap is - returned in buf. Bit 0 is the status change indicator for the root hub. Bit 1 - is the status change indicator for the single root port. Returns 1 if either - change indicator is 1, otherwise returns 0. - */ -int ifxhcd_hub_status_data(struct usb_hcd *_syshcd, char *_buf) -{ - ifxhcd_hcd_t *ifxhcd = syshcd_to_ifxhcd (_syshcd); - - _buf[0] = 0; - _buf[0] |= (ifxhcd->flags.b.port_connect_status_change || - ifxhcd->flags.b.port_reset_change || - ifxhcd->flags.b.port_enable_change || - ifxhcd->flags.b.port_suspend_change || - ifxhcd->flags.b.port_over_current_change) << 1; - - #ifdef __DEBUG__ - if (_buf[0]) - { - IFX_DEBUGPL(DBG_HCD, "IFXUSB HCD HUB STATUS DATA:" - " Root port status changed\n"); - IFX_DEBUGPL(DBG_HCDV, " port_connect_status_change: %d\n", - ifxhcd->flags.b.port_connect_status_change); - IFX_DEBUGPL(DBG_HCDV, " port_reset_change: %d\n", - ifxhcd->flags.b.port_reset_change); - IFX_DEBUGPL(DBG_HCDV, " port_enable_change: %d\n", - ifxhcd->flags.b.port_enable_change); - IFX_DEBUGPL(DBG_HCDV, " port_suspend_change: %d\n", - ifxhcd->flags.b.port_suspend_change); - IFX_DEBUGPL(DBG_HCDV, " port_over_current_change: %d\n", - ifxhcd->flags.b.port_over_current_change); - { - hprt0_data_t hprt0; - hprt0.d32 = ifxusb_rreg(ifxhcd->core_if.hprt0); - IFX_DEBUGPL(DBG_HCDV, " port reg :%08X\n",hprt0.d32); - IFX_DEBUGPL(DBG_HCDV, " port reg :connect: %d/%d\n",hprt0.b.prtconnsts,hprt0.b.prtconndet); - IFX_DEBUGPL(DBG_HCDV, " port reg :enable: %d/%d\n",hprt0.b.prtena,hprt0.b.prtenchng); - IFX_DEBUGPL(DBG_HCDV, " port reg :OC: %d/%d\n",hprt0.b.prtovrcurract,hprt0.b.prtovrcurrchng); - IFX_DEBUGPL(DBG_HCDV, " port reg :rsume/suspend/reset: %d/%d/%d\n",hprt0.b.prtres,hprt0.b.prtsusp,hprt0.b.prtrst); - IFX_DEBUGPL(DBG_HCDV, " port reg :port power: %d/\n",hprt0.b.prtpwr); - IFX_DEBUGPL(DBG_HCDV, " port reg :speed: %d/\n",hprt0.b.prtspd); - } - } - #endif //__DEBUG__ - return (_buf[0] != 0); -} - -#ifdef __WITH_HS_ELECT_TST__ - extern void do_setup(ifxusb_core_if_t *_core_if) ; - extern void do_in_ack(ifxusb_core_if_t *_core_if); -#endif //__WITH_HS_ELECT_TST__ - -/*! - \brief Handles hub class-specific requests. - */ -int ifxhcd_hub_control( struct usb_hcd *_syshcd, - u16 _typeReq, - u16 _wValue, - u16 _wIndex, - char *_buf, - u16 _wLength) -{ - int retval = 0; - ifxhcd_hcd_t *ifxhcd = syshcd_to_ifxhcd (_syshcd); - ifxusb_core_if_t *core_if = &ifxhcd->core_if; - struct usb_hub_descriptor *desc; - hprt0_data_t hprt0 = {.d32 = 0}; - - uint32_t port_status; - - switch (_typeReq) - { - case ClearHubFeature: - IFX_DEBUGPL (DBG_HCD, "IFXUSB HCD HUB CONTROL - " - "ClearHubFeature 0x%x\n", _wValue); - switch (_wValue) - { - case C_HUB_LOCAL_POWER: - case C_HUB_OVER_CURRENT: - /* Nothing required here */ - break; - default: - retval = -EINVAL; - IFX_ERROR ("IFXUSB HCD - " - "ClearHubFeature request %xh unknown\n", _wValue); - } - break; - case ClearPortFeature: - if (!_wIndex || _wIndex > 1) - goto error; - - switch (_wValue) - { - case USB_PORT_FEAT_ENABLE: - IFX_DEBUGPL (DBG_ANY, "IFXUSB HCD HUB CONTROL - " - "ClearPortFeature USB_PORT_FEAT_ENABLE\n"); - hprt0.d32 = ifxusb_read_hprt0 (core_if); - hprt0.b.prtena = 1; - ifxusb_wreg(core_if->hprt0, hprt0.d32); - break; - case USB_PORT_FEAT_SUSPEND: - IFX_DEBUGPL (DBG_HCD, "IFXUSB HCD HUB CONTROL - " - "ClearPortFeature USB_PORT_FEAT_SUSPEND\n"); - hprt0.d32 = ifxusb_read_hprt0 (core_if); - hprt0.b.prtres = 1; - ifxusb_wreg(core_if->hprt0, hprt0.d32); - /* Clear Resume bit */ - mdelay (100); - hprt0.b.prtres = 0; - ifxusb_wreg(core_if->hprt0, hprt0.d32); - break; - case USB_PORT_FEAT_POWER: - IFX_DEBUGPL (DBG_HCD, "IFXUSB HCD HUB CONTROL - " - "ClearPortFeature USB_PORT_FEAT_POWER\n"); - #ifdef __IS_DUAL__ - ifxusb_vbus_off(core_if); - #else - ifxusb_vbus_off(core_if); - #endif - hprt0.d32 = ifxusb_read_hprt0 (core_if); - hprt0.b.prtpwr = 0; - ifxusb_wreg(core_if->hprt0, hprt0.d32); - break; - case USB_PORT_FEAT_INDICATOR: - IFX_DEBUGPL (DBG_HCD, "IFXUSB HCD HUB CONTROL - " - "ClearPortFeature USB_PORT_FEAT_INDICATOR\n"); - /* Port inidicator not supported */ - break; - case USB_PORT_FEAT_C_CONNECTION: - /* Clears drivers internal connect status change - * flag */ - IFX_DEBUGPL (DBG_HCD, "IFXUSB HCD HUB CONTROL - " - "ClearPortFeature USB_PORT_FEAT_C_CONNECTION\n"); - ifxhcd->flags.b.port_connect_status_change = 0; - break; - case USB_PORT_FEAT_C_RESET: - /* Clears the driver's internal Port Reset Change - * flag */ - IFX_DEBUGPL (DBG_HCD, "IFXUSB HCD HUB CONTROL - " - "ClearPortFeature USB_PORT_FEAT_C_RESET\n"); - ifxhcd->flags.b.port_reset_change = 0; - break; - case USB_PORT_FEAT_C_ENABLE: - /* Clears the driver's internal Port - * Enable/Disable Change flag */ - IFX_DEBUGPL (DBG_HCD, "IFXUSB HCD HUB CONTROL - " - "ClearPortFeature USB_PORT_FEAT_C_ENABLE\n"); - ifxhcd->flags.b.port_enable_change = 0; - break; - case USB_PORT_FEAT_C_SUSPEND: - /* Clears the driver's internal Port Suspend - * Change flag, which is set when resume signaling on - * the host port is complete */ - IFX_DEBUGPL (DBG_HCD, "IFXUSB HCD HUB CONTROL - " - "ClearPortFeature USB_PORT_FEAT_C_SUSPEND\n"); - ifxhcd->flags.b.port_suspend_change = 0; - break; - case USB_PORT_FEAT_C_OVER_CURRENT: - IFX_DEBUGPL (DBG_HCD, "IFXUSB HCD HUB CONTROL - " - "ClearPortFeature USB_PORT_FEAT_C_OVER_CURRENT\n"); - ifxhcd->flags.b.port_over_current_change = 0; - break; - default: - retval = -EINVAL; - IFX_ERROR ("IFXUSB HCD - " - "ClearPortFeature request %xh " - "unknown or unsupported\n", _wValue); - } - break; - case GetHubDescriptor: - IFX_DEBUGPL (DBG_HCD, "IFXUSB HCD HUB CONTROL - " - "GetHubDescriptor\n"); - desc = (struct usb_hub_descriptor *)_buf; - desc->bDescLength = 9; - desc->bDescriptorType = 0x29; - desc->bNbrPorts = 1; - desc->wHubCharacteristics = 0x08; - desc->bPwrOn2PwrGood = 1; - desc->bHubContrCurrent = 0; - - desc->u.hs.DeviceRemovable[0] = 0; - desc->u.hs.DeviceRemovable[1] = 1; - /*desc->bitmap[0] = 0; - desc->bitmap[1] = 0xff;*/ - break; - case GetHubStatus: - IFX_DEBUGPL (DBG_HCD, "IFXUSB HCD HUB CONTROL - " - "GetHubStatus\n"); - memset (_buf, 0, 4); - break; - case GetPortStatus: - IFX_DEBUGPL (DBG_HCD, "IFXUSB HCD HUB CONTROL - " - "GetPortStatus\n"); - if (!_wIndex || _wIndex > 1) - goto error; - port_status = 0; - if (ifxhcd->flags.b.port_connect_status_change) - port_status |= (1 << USB_PORT_FEAT_C_CONNECTION); - if (ifxhcd->flags.b.port_enable_change) - port_status |= (1 << USB_PORT_FEAT_C_ENABLE); - if (ifxhcd->flags.b.port_suspend_change) - port_status |= (1 << USB_PORT_FEAT_C_SUSPEND); - if (ifxhcd->flags.b.port_reset_change) - port_status |= (1 << USB_PORT_FEAT_C_RESET); - if (ifxhcd->flags.b.port_over_current_change) - { - IFX_ERROR("Device Not Supported\n"); - port_status |= (1 << USB_PORT_FEAT_C_OVER_CURRENT); - } - if (!ifxhcd->flags.b.port_connect_status) - { - /* - * The port is disconnected, which means the core is - * either in device mode or it soon will be. Just - * return 0's for the remainder of the port status - * since the port register can't be read if the core - * is in device mode. - */ - *((u32 *) _buf) = cpu_to_le32(port_status); - break; - } - - hprt0.d32 = ifxusb_rreg(core_if->hprt0); - IFX_DEBUGPL(DBG_HCDV, " HPRT0: 0x%08x\n", hprt0.d32); - if (hprt0.b.prtconnsts) - port_status |= (1 << USB_PORT_FEAT_CONNECTION); - if (hprt0.b.prtena) - { - ifxhcd->disconnecting=0; - port_status |= (1 << USB_PORT_FEAT_ENABLE); - } - if (hprt0.b.prtsusp) - port_status |= (1 << USB_PORT_FEAT_SUSPEND); - if (hprt0.b.prtovrcurract) - port_status |= (1 << USB_PORT_FEAT_OVER_CURRENT); - if (hprt0.b.prtrst) - port_status |= (1 << USB_PORT_FEAT_RESET); - if (hprt0.b.prtpwr) - port_status |= (1 << USB_PORT_FEAT_POWER); - if (hprt0.b.prtspd == IFXUSB_HPRT0_PRTSPD_HIGH_SPEED) - port_status |= USB_PORT_STAT_HIGH_SPEED; - else if (hprt0.b.prtspd == IFXUSB_HPRT0_PRTSPD_LOW_SPEED) - port_status |= USB_PORT_STAT_LOW_SPEED; - if (hprt0.b.prttstctl) - port_status |= (1 << USB_PORT_FEAT_TEST); - /* USB_PORT_FEAT_INDICATOR unsupported always 0 */ - *((u32 *) _buf) = cpu_to_le32(port_status); - break; - case SetHubFeature: - IFX_DEBUGPL (DBG_HCD, "IFXUSB HCD HUB CONTROL - " - "SetHubFeature\n"); - /* No HUB features supported */ - break; - case SetPortFeature: - if (_wValue != USB_PORT_FEAT_TEST && (!_wIndex || _wIndex > 1)) - goto error; - /* - * The port is disconnected, which means the core is - * either in device mode or it soon will be. Just - * return without doing anything since the port - * register can't be written if the core is in device - * mode. - */ - if (!ifxhcd->flags.b.port_connect_status) - break; - switch (_wValue) - { - case USB_PORT_FEAT_SUSPEND: - IFX_DEBUGPL (DBG_HCD, "IFXUSB HCD HUB CONTROL - " - "SetPortFeature - USB_PORT_FEAT_SUSPEND\n"); - hprt0.d32 = ifxusb_read_hprt0 (core_if); - hprt0.b.prtsusp = 1; - ifxusb_wreg(core_if->hprt0, hprt0.d32); - //IFX_PRINT( "SUSPEND: HPRT0=%0x\n", hprt0.d32); - /* Suspend the Phy Clock */ - { - pcgcctl_data_t pcgcctl = {.d32=0}; - pcgcctl.b.stoppclk = 1; - ifxusb_wreg(core_if->pcgcctl, pcgcctl.d32); - } - break; - case USB_PORT_FEAT_POWER: - IFX_DEBUGPL (DBG_HCD, "IFXUSB HCD HUB CONTROL - " - "SetPortFeature - USB_PORT_FEAT_POWER\n"); - ifxusb_vbus_on (core_if); - hprt0.d32 = ifxusb_read_hprt0 (core_if); - hprt0.b.prtpwr = 1; - ifxusb_wreg(core_if->hprt0, hprt0.d32); - break; - case USB_PORT_FEAT_RESET: - IFX_DEBUGPL (DBG_HCD, "IFXUSB HCD HUB CONTROL - " - "SetPortFeature - USB_PORT_FEAT_RESET\n"); - hprt0.d32 = ifxusb_read_hprt0 (core_if); - hprt0.b.prtrst = 1; - ifxusb_wreg(core_if->hprt0, hprt0.d32); - /* Clear reset bit in 10ms (FS/LS) or 50ms (HS) */ - MDELAY (60); - hprt0.b.prtrst = 0; - ifxusb_wreg(core_if->hprt0, hprt0.d32); - break; - #ifdef __WITH_HS_ELECT_TST__ - case USB_PORT_FEAT_TEST: - { - uint32_t t; - gint_data_t gintmsk; - t = (_wIndex >> 8); /* MSB wIndex USB */ - IFX_DEBUGPL (DBG_HCD, "IFXUSB HCD HUB CONTROL - " - "SetPortFeature - USB_PORT_FEAT_TEST %d\n", t); - warn("USB_PORT_FEAT_TEST %d\n", t); - if (t < 6) - { - hprt0.d32 = ifxusb_read_hprt0 (core_if); - hprt0.b.prttstctl = t; - ifxusb_wreg(core_if->hprt0, hprt0.d32); - } - else if (t == 6) /* HS_HOST_PORT_SUSPEND_RESUME */ - { - /* Save current interrupt mask */ - gintmsk.d32 = ifxusb_rreg(&core_if->core_global_regs->gintmsk); - - /* Disable all interrupts while we muck with - * the hardware directly - */ - ifxusb_wreg(&core_if->core_global_regs->gintmsk, 0); - - /* 15 second delay per the test spec */ - mdelay(15000); - - /* Drive suspend on the root port */ - hprt0.d32 = ifxusb_read_hprt0 (core_if); - hprt0.b.prtsusp = 1; - hprt0.b.prtres = 0; - ifxusb_wreg(core_if->hprt0, hprt0.d32); - - /* 15 second delay per the test spec */ - mdelay(15000); - - /* Drive resume on the root port */ - hprt0.d32 = ifxusb_read_hprt0 (core_if); - hprt0.b.prtsusp = 0; - hprt0.b.prtres = 1; - ifxusb_wreg(core_if->hprt0, hprt0.d32); - mdelay(100); - - /* Clear the resume bit */ - hprt0.b.prtres = 0; - ifxusb_wreg(core_if->hprt0, hprt0.d32); - - /* Restore interrupts */ - ifxusb_wreg(&core_if->core_global_regs->gintmsk, gintmsk.d32); - } - else if (t == 7) /* SINGLE_STEP_GET_DEVICE_DESCRIPTOR setup */ - { - /* Save current interrupt mask */ - gintmsk.d32 = ifxusb_rreg(&core_if->core_global_regs->gintmsk); - - /* Disable all interrupts while we muck with - * the hardware directly - */ - ifxusb_wreg(&core_if->core_global_regs->gintmsk, 0); - - /* 15 second delay per the test spec */ - mdelay(15000); - - /* Send the Setup packet */ - do_setup(core_if); - - /* 15 second delay so nothing else happens for awhile */ - mdelay(15000); - - /* Restore interrupts */ - ifxusb_wreg(&core_if->core_global_regs->gintmsk, gintmsk.d32); - } - - else if (t == 8) /* SINGLE_STEP_GET_DEVICE_DESCRIPTOR execute */ - { - /* Save current interrupt mask */ - gintmsk.d32 = ifxusb_rreg(&core_if->core_global_regs->gintmsk); - - /* Disable all interrupts while we muck with - * the hardware directly - */ - ifxusb_wreg(&core_if->core_global_regs->gintmsk, 0); - - /* Send the Setup packet */ - do_setup(core_if); - - /* 15 second delay so nothing else happens for awhile */ - mdelay(15000); - - /* Send the In and Ack packets */ - do_in_ack(core_if); - - /* 15 second delay so nothing else happens for awhile */ - mdelay(15000); - - /* Restore interrupts */ - ifxusb_wreg(&core_if->core_global_regs->gintmsk, gintmsk.d32); - } - } - break; - #endif //__WITH_HS_ELECT_TST__ - case USB_PORT_FEAT_INDICATOR: - IFX_DEBUGPL (DBG_HCD, "IFXUSB HCD HUB CONTROL - " - "SetPortFeature - USB_PORT_FEAT_INDICATOR\n"); - /* Not supported */ - break; - default: - retval = -EINVAL; - IFX_ERROR ("IFXUSB HCD - " - "SetPortFeature request %xh " - "unknown or unsupported\n", _wValue); - } - break; - default: - error: - retval = -EINVAL; - IFX_WARN ("IFXUSB HCD - " - "Unknown hub control request type or invalid typeReq: %xh wIndex: %xh wValue: %xh\n", - _typeReq, _wIndex, _wValue); - } - return retval; -} - - - - -/*! - \brief This function trigger a data transfer for a host channel and - starts the transfer. - - For a PING transfer in Slave mode, the Do Ping bit is set in the HCTSIZ - register along with a packet count of 1 and the channel is enabled. This - causes a single PING transaction to occur. Other fields in HCTSIZ are - simply set to 0 since no data transfer occurs in this case. - - For a PING transfer in DMA mode, the HCTSIZ register is initialized with - all the information required to perform the subsequent data transfer. In - addition, the Do Ping bit is set in the HCTSIZ register. In this case, the - controller performs the entire PING protocol, then starts the data - transfer. - \param _core_if Pointer of core_if structure - \param _ifxhc Information needed to initialize the host channel. The xfer_len - value may be reduced to accommodate the max widths of the XferSize and - PktCnt fields in the HCTSIZn register. The multi_count value may be changed - to reflect the final xfer_len value. - */ -void ifxhcd_hc_start(ifxhcd_hcd_t *_ifxhcd, ifxhcd_hc_t *_ifxhc) -{ - ifxusb_core_if_t *core_if = &_ifxhcd->core_if; - uint32_t max_hc_xfer_size = core_if->params.max_transfer_size; - uint16_t max_hc_pkt_count = core_if->params.max_packet_count; - ifxusb_hc_regs_t *hc_regs = core_if->hc_regs[_ifxhc->hc_num]; - hfnum_data_t hfnum; - - hprt0_data_t hprt0; - - if(_ifxhc->epqh->urbd->phase==URBD_DEQUEUEING) - return; - - hprt0.d32 = ifxusb_read_hprt0(core_if); - - if(_ifxhcd->pkt_remaining==0) - return; - -#if 0 - if(_ifxhc->phase!=HC_WAITING) - printk(KERN_INFO "%s() line %d: _ifxhc->phase!=HC_WAITING :%d\n",__func__,__LINE__,_ifxhc->phase); - if(_ifxhc->epqh->urbd->phase==URBD_IDLE ) printk(KERN_INFO "%s() line %d: _ifxhc->epqh->urbd->phase==URBD_IDLE\n",__func__,__LINE__); -// if(_ifxhc->epqh->urbd->phase==URBD_ACTIVE ) printk(KERN_INFO "%s() line %d: _ifxhc->epqh->urbd->phase==URBD_ACTIVE\n",__func__,__LINE__); - if(_ifxhc->epqh->urbd->phase==URBD_STARTING ) printk(KERN_INFO "%s() line %d: _ifxhc->epqh->urbd->phase==URBD_STARTING\n",__func__,__LINE__); - if(_ifxhc->epqh->urbd->phase==URBD_STARTED ) printk(KERN_INFO "%s() line %d: _ifxhc->epqh->urbd->phase==URBD_STARTED\n",__func__,__LINE__); - if(_ifxhc->epqh->urbd->phase==URBD_COMPLETING) printk(KERN_INFO "%s() line %d: _ifxhc->epqh->urbd->phase==URBD_COMPLETING\n",__func__,__LINE__); - if(_ifxhc->epqh->urbd->phase==URBD_DEQUEUEING) printk(KERN_INFO "%s() line %d: _ifxhc->epqh->urbd->phase==URBD_DEQUEUEING\n",__func__,__LINE__); - if(_ifxhc->epqh->urbd->phase==URBD_FINISHING ) printk(KERN_INFO "%s() line %d: _ifxhc->epqh->urbd->phase==URBD_FINISHING\n",__func__,__LINE__); -#endif - - if (hprt0.b.prtspd == IFXUSB_HPRT0_PRTSPD_HIGH_SPEED) - { - if (_ifxhc->split) - { - if(max_hc_pkt_count > _ifxhcd->pkt_remaining) - max_hc_pkt_count = _ifxhcd->pkt_remaining; - } - else if(_ifxhc->ep_type == IFXUSB_EP_TYPE_BULK) - { - if( _ifxhc->is_in && _ifxhcd->pkt_count_limit_bi && max_hc_pkt_count > _ifxhcd->pkt_count_limit_bi) - max_hc_pkt_count = _ifxhcd->pkt_count_limit_bi; - if(!_ifxhc->is_in && _ifxhcd->pkt_count_limit_bo && max_hc_pkt_count > _ifxhcd->pkt_count_limit_bo) - max_hc_pkt_count = _ifxhcd->pkt_count_limit_bo; - if(max_hc_pkt_count*8 > _ifxhcd->pkt_remaining) - max_hc_pkt_count = _ifxhcd->pkt_remaining/8; - } - else - { - if(max_hc_pkt_count > _ifxhcd->pkt_remaining) - max_hc_pkt_count = _ifxhcd->pkt_remaining; - } - } - else if (hprt0.b.prtspd == IFXUSB_HPRT0_PRTSPD_LOW_SPEED) - { - if(max_hc_pkt_count > _ifxhcd->pkt_remaining) - max_hc_pkt_count = _ifxhcd->pkt_remaining; - } - else - { - if(max_hc_pkt_count > _ifxhcd->pkt_remaining) - max_hc_pkt_count = _ifxhcd->pkt_remaining; - } - - if(max_hc_pkt_count==0) - return; - - if(max_hc_pkt_count * _ifxhc->mps < max_hc_xfer_size) - max_hc_xfer_size = max_hc_pkt_count * _ifxhc->mps; - - _ifxhc->epqh->urbd->phase=URBD_STARTING; - - if(_ifxhc->is_in || _ifxhc->speed != IFXUSB_EP_SPEED_HIGH || _ifxhc->xfer_len==0) - _ifxhc->epqh->do_ping=0; - if(_ifxhc->ep_type == IFXUSB_EP_TYPE_INTR || _ifxhc->ep_type == IFXUSB_EP_TYPE_ISOC) - _ifxhc->epqh->do_ping=0; - if(_ifxhc->ep_type == IFXUSB_EP_TYPE_CTRL && _ifxhc->control_phase != IFXHCD_CONTROL_DATA ) - _ifxhc->epqh->do_ping=0; - - if (_ifxhc->split > 0) - { - _ifxhc->start_pkt_count = 1; - if(!_ifxhc->is_in && _ifxhc->split>1) // OUT CSPLIT - _ifxhc->xfer_len = 0; - if (_ifxhc->xfer_len > _ifxhc->mps) - _ifxhc->xfer_len = _ifxhc->mps; - if (_ifxhc->xfer_len > 188) - _ifxhc->xfer_len = 188; - } - else if(_ifxhc->is_in) - { - _ifxhc->short_rw = 0; - if (_ifxhc->xfer_len > 0) - { - if (_ifxhc->xfer_len > max_hc_xfer_size) - _ifxhc->xfer_len = max_hc_xfer_size - _ifxhc->mps + 1; - _ifxhc->start_pkt_count = (_ifxhc->xfer_len + _ifxhc->mps - 1) / _ifxhc->mps; - if (_ifxhc->start_pkt_count > max_hc_pkt_count) - _ifxhc->start_pkt_count = max_hc_pkt_count; - } - else /* Need 1 packet for transfer length of 0. */ - _ifxhc->start_pkt_count = 1; - _ifxhc->xfer_len = _ifxhc->start_pkt_count * _ifxhc->mps; - } - else //non-split out - { - if (_ifxhc->xfer_len == 0) - { - if(_ifxhc->short_rw==0) - printk(KERN_INFO "Info: %s() line %d: ZLP write without short_rw set! xfer_count:%d/%d \n",__func__,__LINE__, - _ifxhc->xfer_count, - _ifxhc->epqh->urbd->xfer_len); - _ifxhc->start_pkt_count = 1; - } - else - { - if (_ifxhc->xfer_len > max_hc_xfer_size) - { - _ifxhc->start_pkt_count = (max_hc_xfer_size / _ifxhc->mps); - _ifxhc->xfer_len = _ifxhc->start_pkt_count * _ifxhc->mps; - } - else - { - _ifxhc->start_pkt_count = (_ifxhc->xfer_len+_ifxhc->mps-1) / _ifxhc->mps; -// if(_ifxhc->start_pkt_count * _ifxhc->mps == _ifxhc->xfer_len ) -// _ifxhc->start_pkt_count += _ifxhc->short_rw; - } - } - } - - if (hprt0.b.prtspd == IFXUSB_HPRT0_PRTSPD_HIGH_SPEED) - { - if (_ifxhc->split) - { - if( _ifxhcd->pkt_remaining > _ifxhc->start_pkt_count) - _ifxhcd->pkt_remaining -= _ifxhc->start_pkt_count; - else - _ifxhcd->pkt_remaining = 0; - } - else if(_ifxhc->ep_type == IFXUSB_EP_TYPE_BULK) - { - if( _ifxhcd->pkt_remaining*8 > _ifxhc->start_pkt_count) - _ifxhcd->pkt_remaining -= (_ifxhc->start_pkt_count*8); - else - _ifxhcd->pkt_remaining = 0; - } - else - { - if( _ifxhcd->pkt_remaining > _ifxhc->start_pkt_count) - _ifxhcd->pkt_remaining -= _ifxhc->start_pkt_count; - else - _ifxhcd->pkt_remaining = 0; - } - } - else if (hprt0.b.prtspd == IFXUSB_HPRT0_PRTSPD_LOW_SPEED) - { - if( _ifxhcd->pkt_remaining > _ifxhc->start_pkt_count) - _ifxhcd->pkt_remaining -= _ifxhc->start_pkt_count; - else - _ifxhcd->pkt_remaining = 0; - } - else - { - if( _ifxhcd->pkt_remaining > _ifxhc->start_pkt_count) - _ifxhcd->pkt_remaining -= _ifxhc->start_pkt_count; - else - _ifxhcd->pkt_remaining = 0; - } - - #ifdef __EN_ISOC__ - if (_ifxhc->ep_type == IFXUSB_EP_TYPE_ISOC) - { - /* Set up the initial PID for the transfer. */ - #if 1 - _ifxhc->data_pid_start = IFXUSB_HC_PID_DATA0; - #else - if (_ifxhc->speed == IFXUSB_EP_SPEED_HIGH) - { - if (_ifxhc->is_in) - { - if (_ifxhc->multi_count == 1) - _ifxhc->data_pid_start = IFXUSB_HC_PID_DATA0; - else if (_ifxhc->multi_count == 2) - _ifxhc->data_pid_start = IFXUSB_HC_PID_DATA1; - else - _ifxhc->data_pid_start = IFXUSB_HC_PID_DATA2; - } - else - { - if (_ifxhc->multi_count == 1) - _ifxhc->data_pid_start = IFXUSB_HC_PID_DATA0; - else - _ifxhc->data_pid_start = IFXUSB_HC_PID_MDATA; - } - } - else - _ifxhc->data_pid_start = IFXUSB_HC_PID_DATA0; - #endif - } - #endif - - IFX_DEBUGPL(DBG_HCDV, "%s: Channel %d\n", __func__, _ifxhc->hc_num); - { - hctsiz_data_t hctsiz= { .d32=0 }; - - hctsiz.b.dopng = _ifxhc->epqh->do_ping; - _ifxhc->epqh->do_ping=0; - - if(_ifxhc->is_in || _ifxhc->speed != IFXUSB_EP_SPEED_HIGH || _ifxhc->xfer_len==0) - hctsiz.b.dopng = 0; - if(_ifxhc->ep_type == IFXUSB_EP_TYPE_INTR || _ifxhc->ep_type == IFXUSB_EP_TYPE_ISOC) - hctsiz.b.dopng = 0; - if(_ifxhc->ep_type == IFXUSB_EP_TYPE_CTRL && _ifxhc->control_phase != IFXHCD_CONTROL_DATA ) - hctsiz.b.dopng = 0; - - hctsiz.b.xfersize = _ifxhc->xfer_len; - hctsiz.b.pktcnt = _ifxhc->start_pkt_count; - hctsiz.b.pid = _ifxhc->data_pid_start; - ifxusb_wreg(&hc_regs->hctsiz, hctsiz.d32); - - IFX_DEBUGPL(DBG_HCDV, " Xfer Size: %d\n", hctsiz.b.xfersize); - IFX_DEBUGPL(DBG_HCDV, " Num Pkts: %d\n" , hctsiz.b.pktcnt); - IFX_DEBUGPL(DBG_HCDV, " Start PID: %d\n", hctsiz.b.pid); - } - IFX_DEBUGPL(DBG_HCDV, " DMA: 0x%08x\n", (uint32_t)(CPHYSADDR( ((uint32_t)(_ifxhc->xfer_buff))+ _ifxhc->xfer_count ))); - ifxusb_wreg(&hc_regs->hcdma, (uint32_t)(CPHYSADDR( ((uint32_t)(_ifxhc->xfer_buff))+ _ifxhc->xfer_count ))); - - /* Start the split */ - if (_ifxhc->split>0) - { - hcsplt_data_t hcsplt; - hcsplt.d32 = ifxusb_rreg (&hc_regs->hcsplt); - hcsplt.b.spltena = 1; - if (_ifxhc->split>1) - hcsplt.b.compsplt = 1; - else - hcsplt.b.compsplt = 0; - - #if defined(__EN_ISOC__) && defined(__EN_ISOC_SPLIT__) - if (_ifxhc->ep_type == IFXUSB_EP_TYPE_ISOC) - hcsplt.b.xactpos = _ifxhc->isoc_xact_pos; - else - #endif - hcsplt.b.xactpos = IFXUSB_HCSPLIT_XACTPOS_ALL;// if not ISO - ifxusb_wreg(&hc_regs->hcsplt, hcsplt.d32); - IFX_DEBUGPL(DBG_HCDV, " SPLIT: XACT_POS:0x%08x\n", hcsplt.d32); - } - - { - hcchar_data_t hcchar; - hcchar.d32 = ifxusb_rreg(&hc_regs->hcchar); -// hcchar.b.multicnt = _ifxhc->multi_count; - hcchar.b.multicnt = 1; - - if (_ifxhc->ep_type == IFXUSB_EP_TYPE_INTR || _ifxhc->ep_type == IFXUSB_EP_TYPE_ISOC) - { - hfnum.d32 = ifxusb_rreg(&core_if->host_global_regs->hfnum); - /* 1 if _next_ frame is odd, 0 if it's even */ - hcchar.b.oddfrm = (hfnum.b.frnum & 0x1) ? 0 : 1; - } - - #ifdef __DEBUG__ - _ifxhc->start_hcchar_val = hcchar.d32; - if (hcchar.b.chdis) - IFX_WARN("%s: chdis set, channel %d, hcchar 0x%08x\n", - __func__, _ifxhc->hc_num, hcchar.d32); - #endif - - /* Set host channel enable after all other setup is complete. */ - hcchar.b.chen = 1; - hcchar.b.chdis = 0; - hcchar.b.epdir = _ifxhc->is_in; - _ifxhc->hcchar=hcchar.d32; - } - - IFX_DEBUGPL(DBG_HCDV, " HCCHART: 0x%08x\n", _ifxhc->hcchar); - - _ifxhc->phase=HC_STARTING; -} - -/*! - \brief Attempts to halt a host channel. This function should only be called - to abort a transfer in DMA mode. Under normal circumstances in DMA mode, the - controller halts the channel when the transfer is complete or a condition - occurs that requires application intervention. - - In DMA mode, always sets the Channel Enable and Channel Disable bits of the - HCCHARn register. The controller ensures there is space in the request - queue before submitting the halt request. - - Some time may elapse before the core flushes any posted requests for this - host channel and halts. The Channel Halted interrupt handler completes the - deactivation of the host channel. - */ -int ifxhcd_hc_halt(ifxusb_core_if_t *_core_if, - ifxhcd_hc_t *_ifxhc, - ifxhcd_halt_status_e _halt_status) -{ - hcchar_data_t hcchar; - ifxusb_hc_regs_t *hc_regs; - hc_regs = _core_if->hc_regs[_ifxhc->hc_num]; - - WARN_ON(_halt_status == HC_XFER_NO_HALT_STATUS); - - { - hprt0_data_t hprt0; - hprt0.d32 = ifxusb_rreg(_core_if->hprt0); - if(hprt0.b.prtena == 0) - return -1; - } - - if (_halt_status == HC_XFER_URB_DEQUEUE || - _halt_status == HC_XFER_AHB_ERR) - { - /* - * Disable all channel interrupts except Ch Halted. The URBD - * and EPQH state associated with this transfer has been cleared - * (in the case of URB_DEQUEUE), so the channel needs to be - * shut down carefully to prevent crashes. - */ - hcint_data_t hcintmsk; - hcintmsk.d32 = 0; - hcintmsk.b.chhltd = 1; - ifxusb_wreg(&hc_regs->hcintmsk, hcintmsk.d32); - - /* - * Make sure no other interrupts besides halt are currently - * pending. Handling another interrupt could cause a crash due - * to the URBD and EPQH state. - */ - ifxusb_wreg(&hc_regs->hcint, ~hcintmsk.d32); - - /* - * Make sure the halt status is set to URB_DEQUEUE or AHB_ERR - * even if the channel was already halted for some other - * reason. - */ - _ifxhc->halt_status = _halt_status; - } - - hcchar.d32 = ifxusb_rreg(&hc_regs->hcchar); - if (hcchar.b.chen == 0) - { - /* - * The channel is either already halted or it hasn't - * started yet. In DMA mode, the transfer may halt if - * it finishes normally or a condition occurs that - * requires driver intervention. Don't want to halt - * the channel again. In either Slave or DMA mode, - * it's possible that the transfer has been assigned - * to a channel, but not started yet when an URB is - * dequeued. Don't want to halt a channel that hasn't - * started yet. - */ - _ifxhc->phase=HC_IDLE; - return -1; - } - - if (_ifxhc->phase==HC_STOPPING) - { - /* - * A halt has already been issued for this channel. This might - * happen when a transfer is aborted by a higher level in - * the stack. - */ - #ifdef __DEBUG__ - IFX_PRINT("*** %s: Channel %d, double halt a channel***\n", - __func__, _ifxhc->hc_num); - #endif - return 0; - } - hcchar.d32 = ifxusb_rreg(&hc_regs->hcchar); - hcchar.b.chen = 1; - hcchar.b.chdis = 1; - - ifxusb_wreg(&hc_regs->hcchar, hcchar.d32); - - _ifxhc->halt_status = _halt_status; - _ifxhc->phase=HC_STOPPING; - - IFX_DEBUGPL(DBG_HCDV, "%s: Channel %d\n" , __func__, _ifxhc->hc_num); - IFX_DEBUGPL(DBG_HCDV, " hcchar: 0x%08x\n" , hcchar.d32); - IFX_DEBUGPL(DBG_HCDV, " halt_status: %d\n" , _ifxhc->halt_status); - - return 0; -} - -/*! - \brief Clears a host channel. - */ -void ifxhcd_hc_cleanup(ifxusb_core_if_t *_core_if, ifxhcd_hc_t *_ifxhc) -{ - ifxusb_hc_regs_t *hc_regs; - - _ifxhc->phase=HC_IDLE; - _ifxhc->epqh=0; - - /* - * Clear channel interrupt enables and any unhandled channel interrupt - * conditions. - */ - hc_regs = _core_if->hc_regs[_ifxhc->hc_num]; - ifxusb_wreg(&hc_regs->hcintmsk, 0); - ifxusb_wreg(&hc_regs->hcint, 0xFFFFFFFF); - - #ifdef __DEBUG__ - { - hcchar_data_t hcchar; - hcchar.d32 = ifxusb_rreg(&hc_regs->hcchar); - if (hcchar.b.chdis) - IFX_WARN("%s: chdis set, channel %d, hcchar 0x%08x\n", __func__, _ifxhc->hc_num, hcchar.d32); - } - #endif -} - - - - - -#ifdef __DEBUG__ - static void dump_urb_info(struct urb *_urb, char* _fn_name) - { - IFX_PRINT("%s, urb %p\n" , _fn_name, _urb); - IFX_PRINT(" Device address: %d\n", usb_pipedevice(_urb->pipe)); - IFX_PRINT(" Endpoint: %d, %s\n" , usb_pipeendpoint(_urb->pipe), - (usb_pipein(_urb->pipe) ? "IN" : "OUT")); - IFX_PRINT(" Endpoint type: %s\n", - ({ char *pipetype; - switch (usb_pipetype(_urb->pipe)) { - case PIPE_CONTROL: pipetype = "CONTROL"; break; - case PIPE_BULK: pipetype = "BULK"; break; - case PIPE_INTERRUPT: pipetype = "INTERRUPT"; break; - case PIPE_ISOCHRONOUS: pipetype = "ISOCHRONOUS"; break; - default: pipetype = "UNKNOWN"; break; - }; - pipetype; - })); - IFX_PRINT(" Speed: %s\n", - ({ char *speed; - switch (_urb->dev->speed) { - case USB_SPEED_HIGH: speed = "HIGH"; break; - case USB_SPEED_FULL: speed = "FULL"; break; - case USB_SPEED_LOW: speed = "LOW"; break; - default: speed = "UNKNOWN"; break; - }; - speed; - })); - IFX_PRINT(" Max packet size: %d\n", - usb_maxpacket(_urb->dev, _urb->pipe, usb_pipeout(_urb->pipe))); - IFX_PRINT(" Data buffer length: %d\n", _urb->transfer_buffer_length); - IFX_PRINT(" Transfer buffer: %p, Transfer DMA: %p\n", - _urb->transfer_buffer, (void *)_urb->transfer_dma); - IFX_PRINT(" Setup buffer: %p, Setup DMA: %p\n", - _urb->setup_packet, (void *)_urb->setup_dma); - IFX_PRINT(" Interval: %d\n", _urb->interval); - if (usb_pipetype(_urb->pipe) == PIPE_ISOCHRONOUS) - { - int i; - for (i = 0; i < _urb->number_of_packets; i++) - { - IFX_PRINT(" ISO Desc %d:\n", i); - IFX_PRINT(" offset: %d, length %d\n", - _urb->iso_frame_desc[i].offset, - _urb->iso_frame_desc[i].length); - } - } - } - -#if 0 - static void dump_channel_info(ifxhcd_hcd_t *_ifxhcd, ifxhcd_epqh_t *_epqh) - { - if (_epqh->hc != NULL) - { - ifxhcd_hc_t *hc = _epqh->hc; - struct list_head *item; - ifxhcd_epqh_t *epqh_item; - - ifxusb_hc_regs_t *hc_regs; - - hcchar_data_t hcchar; - hcsplt_data_t hcsplt; - hctsiz_data_t hctsiz; - uint32_t hcdma; - - hc_regs = _ifxhcd->core_if.hc_regs[hc->hc_num]; - hcchar.d32 = ifxusb_rreg(&hc_regs->hcchar); - hcsplt.d32 = ifxusb_rreg(&hc_regs->hcsplt); - hctsiz.d32 = ifxusb_rreg(&hc_regs->hctsiz); - hcdma = ifxusb_rreg(&hc_regs->hcdma); - - IFX_PRINT(" Assigned to channel %d:\n" , hc->hc_num); - IFX_PRINT(" hcchar 0x%08x, hcsplt 0x%08x\n", hcchar.d32, hcsplt.d32); - IFX_PRINT(" hctsiz 0x%08x, hcdma 0x%08x\n" , hctsiz.d32, hcdma); - IFX_PRINT(" dev_addr: %d, ep_num: %d, is_in: %d\n", - hc->dev_addr, hc->ep_num, hc->is_in); - IFX_PRINT(" ep_type: %d\n" , hc->ep_type); - IFX_PRINT(" max_packet_size: %d\n", hc->mps); - IFX_PRINT(" data_pid_start: %d\n" , hc->data_pid_start); - IFX_PRINT(" halt_status: %d\n" , hc->halt_status); - IFX_PRINT(" xfer_buff: %p\n" , hc->xfer_buff); - IFX_PRINT(" xfer_len: %d\n" , hc->xfer_len); - IFX_PRINT(" epqh: %p\n" , hc->epqh); - IFX_PRINT(" NP :\n"); - list_for_each(item, &_ifxhcd->epqh_list_np) - { - epqh_item = list_entry(item, ifxhcd_epqh_t, ql); - IFX_PRINT(" %p\n", epqh_item); - } - IFX_PRINT(" INTR :\n"); - list_for_each(item, &_ifxhcd->epqh_list_intr) - { - epqh_item = list_entry(item, ifxhcd_epqh_t, ql); - IFX_PRINT(" %p\n", epqh_item); - } - #ifdef __EN_ISOC__ - IFX_PRINT(" ISOC:\n"); - list_for_each(item, &_ifxhcd->epqh_list_isoc) - { - epqh_item = list_entry(item, ifxhcd_epqh_t, ql); - IFX_PRINT(" %p\n", epqh_item); - } - #endif - } - } -#endif -#endif //__DEBUG__ - - -/*! - \brief This function writes a packet into the Tx FIFO associated with the Host - Channel. For a channel associated with a non-periodic EP, the non-periodic - Tx FIFO is written. For a channel associated with a periodic EP, the - periodic Tx FIFO is written. This function should only be called in Slave - mode. - - Upon return the xfer_buff and xfer_count fields in _hc are incremented by - then number of bytes written to the Tx FIFO. - */ - -#ifdef __ENABLE_DUMP__ - void ifxhcd_dump_state(ifxhcd_hcd_t *_ifxhcd) - { - int num_channels; - int i; - num_channels = _ifxhcd->core_if.params.host_channels; - IFX_PRINT("\n"); - IFX_PRINT("************************************************************\n"); - IFX_PRINT("HCD State:\n"); - IFX_PRINT(" Num channels: %d\n", num_channels); - for (i = 0; i < num_channels; i++) { - ifxhcd_hc_t *hc = &_ifxhcd->ifxhc[i]; - IFX_PRINT(" Channel %d:\n", hc->hc_num); - IFX_PRINT(" dev_addr: %d, ep_num: %d, ep_is_in: %d\n", - hc->dev_addr, hc->ep_num, hc->is_in); - IFX_PRINT(" speed: %d\n" , hc->speed); - IFX_PRINT(" ep_type: %d\n" , hc->ep_type); - IFX_PRINT(" mps: %d\n", hc->mps); - IFX_PRINT(" data_pid_start: %d\n" , hc->data_pid_start); - IFX_PRINT(" xfer_buff: %p\n" , hc->xfer_buff); - IFX_PRINT(" xfer_len: %d\n" , hc->xfer_len); - IFX_PRINT(" xfer_count: %d\n" , hc->xfer_count); - IFX_PRINT(" halt_status: %d\n" , hc->halt_status); - IFX_PRINT(" split: %d\n" , hc->split); - IFX_PRINT(" hub_addr: %d\n" , hc->hub_addr); - IFX_PRINT(" port_addr: %d\n" , hc->port_addr); - #if defined(__EN_ISOC__) && defined(__EN_ISOC_SPLIT__) - IFX_PRINT(" isoc_xact_pos: %d\n" , hc->isoc_xact_pos); - #endif - - IFX_PRINT(" epqh: %p\n" , hc->epqh); - IFX_PRINT(" short_rw: %d\n" , hc->short_rw); - IFX_PRINT(" control_phase: %d\n" , hc->control_phase); - if(hc->epqh) - { - IFX_PRINT(" do_ping: %d\n" , hc->epqh->do_ping); - } - IFX_PRINT(" start_pkt_count: %d\n" , hc->start_pkt_count); - } - IFX_PRINT("************************************************************\n"); - IFX_PRINT("\n"); - } -#endif //__ENABLE_DUMP__ - |