mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
110 lines
2.4 KiB
110 lines
2.4 KiB
// SPDX-License-Identifier: GPL-2.0+ |
|
/* |
|
* Freescale QUICC Engine USB Host Controller Driver |
|
* |
|
* Copyright (c) Freescale Semicondutor, Inc. 2006. |
|
* Shlomi Gridish <[email protected]> |
|
* Jerry Huang <[email protected]> |
|
* Copyright (c) Logic Product Development, Inc. 2007 |
|
* Peter Barada <[email protected]> |
|
* Copyright (c) MontaVista Software, Inc. 2008. |
|
* Anton Vorontsov <[email protected]> |
|
*/ |
|
|
|
#include <linux/kernel.h> |
|
#include <linux/types.h> |
|
#include <linux/delay.h> |
|
#include <linux/slab.h> |
|
#include <linux/list.h> |
|
#include <linux/usb.h> |
|
#include <linux/usb/hcd.h> |
|
#include "fhci.h" |
|
|
|
static void init_td(struct td *td) |
|
{ |
|
memset(td, 0, sizeof(*td)); |
|
INIT_LIST_HEAD(&td->node); |
|
INIT_LIST_HEAD(&td->frame_lh); |
|
} |
|
|
|
static void init_ed(struct ed *ed) |
|
{ |
|
memset(ed, 0, sizeof(*ed)); |
|
INIT_LIST_HEAD(&ed->td_list); |
|
INIT_LIST_HEAD(&ed->node); |
|
} |
|
|
|
static struct td *get_empty_td(struct fhci_hcd *fhci) |
|
{ |
|
struct td *td; |
|
|
|
if (!list_empty(&fhci->empty_tds)) { |
|
td = list_entry(fhci->empty_tds.next, struct td, node); |
|
list_del(fhci->empty_tds.next); |
|
} else { |
|
td = kmalloc(sizeof(*td), GFP_ATOMIC); |
|
if (!td) |
|
fhci_err(fhci, "No memory to allocate to TD\n"); |
|
else |
|
init_td(td); |
|
} |
|
|
|
return td; |
|
} |
|
|
|
void fhci_recycle_empty_td(struct fhci_hcd *fhci, struct td *td) |
|
{ |
|
init_td(td); |
|
list_add(&td->node, &fhci->empty_tds); |
|
} |
|
|
|
struct ed *fhci_get_empty_ed(struct fhci_hcd *fhci) |
|
{ |
|
struct ed *ed; |
|
|
|
if (!list_empty(&fhci->empty_eds)) { |
|
ed = list_entry(fhci->empty_eds.next, struct ed, node); |
|
list_del(fhci->empty_eds.next); |
|
} else { |
|
ed = kmalloc(sizeof(*ed), GFP_ATOMIC); |
|
if (!ed) |
|
fhci_err(fhci, "No memory to allocate to ED\n"); |
|
else |
|
init_ed(ed); |
|
} |
|
|
|
return ed; |
|
} |
|
|
|
void fhci_recycle_empty_ed(struct fhci_hcd *fhci, struct ed *ed) |
|
{ |
|
init_ed(ed); |
|
list_add(&ed->node, &fhci->empty_eds); |
|
} |
|
|
|
struct td *fhci_td_fill(struct fhci_hcd *fhci, struct urb *urb, |
|
struct urb_priv *urb_priv, struct ed *ed, u16 index, |
|
enum fhci_ta_type type, int toggle, u8 *data, u32 len, |
|
u16 interval, u16 start_frame, bool ioc) |
|
{ |
|
struct td *td = get_empty_td(fhci); |
|
|
|
if (!td) |
|
return NULL; |
|
|
|
td->urb = urb; |
|
td->ed = ed; |
|
td->type = type; |
|
td->toggle = toggle; |
|
td->data = data; |
|
td->len = len; |
|
td->iso_index = index; |
|
td->interval = interval; |
|
td->start_frame = start_frame; |
|
td->ioc = ioc; |
|
td->status = USB_TD_OK; |
|
|
|
urb_priv->tds[index] = td; |
|
|
|
return td; |
|
}
|
|
|