1236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov/* 2236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov * Freescale QUICC Engine USB Host Controller Driver 3236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov * 4236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov * Copyright (c) Freescale Semicondutor, Inc. 2006. 5236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov * Shlomi Gridish <gridish@freescale.com> 6236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov * Jerry Huang <Chang-Ming.Huang@freescale.com> 7236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov * Copyright (c) Logic Product Development, Inc. 2007 8236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov * Peter Barada <peterb@logicpd.com> 9236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov * Copyright (c) MontaVista Software, Inc. 2008. 10236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov * Anton Vorontsov <avorontsov@ru.mvista.com> 11236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov * 12236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov * This program is free software; you can redistribute it and/or modify it 13236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov * under the terms of the GNU General Public License as published by the 14236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov * Free Software Foundation; either version 2 of the License, or (at your 15236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov * option) any later version. 16236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov */ 17236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov 18236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov#include <linux/kernel.h> 19236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov#include <linux/types.h> 20236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov#include <linux/delay.h> 215a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 22236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov#include <linux/list.h> 23236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov#include <linux/usb.h> 2427729aadd31dafddaaf64c24f8ef6d0ff750f3aaEric Lescouet#include <linux/usb/hcd.h> 25236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov#include "fhci.h" 26236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov 27236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsovstatic void init_td(struct td *td) 28236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov{ 29236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov memset(td, 0, sizeof(*td)); 30236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov INIT_LIST_HEAD(&td->node); 31236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov INIT_LIST_HEAD(&td->frame_lh); 32236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov} 33236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov 34236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsovstatic void init_ed(struct ed *ed) 35236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov{ 36236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov memset(ed, 0, sizeof(*ed)); 37236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov INIT_LIST_HEAD(&ed->td_list); 38236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov INIT_LIST_HEAD(&ed->node); 39236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov} 40236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov 41236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsovstatic struct td *get_empty_td(struct fhci_hcd *fhci) 42236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov{ 43236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov struct td *td; 44236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov 45236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov if (!list_empty(&fhci->empty_tds)) { 46236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov td = list_entry(fhci->empty_tds.next, struct td, node); 47236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov list_del(fhci->empty_tds.next); 48236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov } else { 49236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov td = kmalloc(sizeof(*td), GFP_ATOMIC); 50236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov if (!td) 51236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov fhci_err(fhci, "No memory to allocate to TD\n"); 52236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov else 53236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov init_td(td); 54236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov } 55236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov 56236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov return td; 57236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov} 58236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov 59236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsovvoid fhci_recycle_empty_td(struct fhci_hcd *fhci, struct td *td) 60236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov{ 61236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov init_td(td); 62236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov list_add(&td->node, &fhci->empty_tds); 63236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov} 64236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov 65236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsovstruct ed *fhci_get_empty_ed(struct fhci_hcd *fhci) 66236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov{ 67236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov struct ed *ed; 68236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov 69236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov if (!list_empty(&fhci->empty_eds)) { 70236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov ed = list_entry(fhci->empty_eds.next, struct ed, node); 71236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov list_del(fhci->empty_eds.next); 72236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov } else { 73236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov ed = kmalloc(sizeof(*ed), GFP_ATOMIC); 74236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov if (!ed) 75236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov fhci_err(fhci, "No memory to allocate to ED\n"); 76236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov else 77236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov init_ed(ed); 78236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov } 79236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov 80236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov return ed; 81236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov} 82236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov 83236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsovvoid fhci_recycle_empty_ed(struct fhci_hcd *fhci, struct ed *ed) 84236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov{ 85236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov init_ed(ed); 86236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov list_add(&ed->node, &fhci->empty_eds); 87236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov} 88236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov 89236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsovstruct td *fhci_td_fill(struct fhci_hcd *fhci, struct urb *urb, 90236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov struct urb_priv *urb_priv, struct ed *ed, u16 index, 91236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov enum fhci_ta_type type, int toggle, u8 *data, u32 len, 92236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov u16 interval, u16 start_frame, bool ioc) 93236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov{ 94236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov struct td *td = get_empty_td(fhci); 95236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov 96236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov if (!td) 97236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov return NULL; 98236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov 99236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov td->urb = urb; 100236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov td->ed = ed; 101236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov td->type = type; 102236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov td->toggle = toggle; 103236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov td->data = data; 104236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov td->len = len; 105236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov td->iso_index = index; 106236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov td->interval = interval; 107236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov td->start_frame = start_frame; 108236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov td->ioc = ioc; 109236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov td->status = USB_TD_OK; 110236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov 111236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov urb_priv->tds[index] = td; 112236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov 113236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov return td; 114236dd4d18f293e3c9798f35c08272196826a980dAnton Vorontsov} 115