Firebee/BaS_gcc
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

beautified formatting and fixed some (minor) typos

Browse Source
This commit is contained in:
Markus Fröschle
2014-09-03 06:16:55 +00:00
parent 76eb900fec
commit 142a8d7c02
1 changed files with 131 additions and 71 deletions
Download Patch File Download Diff File Expand all files Collapse all files

162
BaS_gcc/pci/ohci-hcd.c
View File

@@ -76,8 +76,9 @@
#define CONFIG_SYS_OHCI_SWAP_REG_ACCESS #define CONFIG_SYS_OHCI_SWAP_REG_ACCESS
#ifdef CONFIG_SYS_OHCI_SWAP_REG_ACCESS #ifdef CONFIG_SYS_OHCI_SWAP_REG_ACCESS
/* /*
#define readl(a) swpl(*((volatile uint32_t *)(a))) * do a longword read from addr and byteswap the result
*/ */
inline uint32_t readl(volatile uint32_t *addr) inline uint32_t readl(volatile uint32_t *addr)
{ {
@@ -90,7 +91,7 @@ inline uint32_t readl(volatile uint32_t *addr)
} }
/* /*
#define writel(a, b) {dbg("writing %08x to %08x\r\n", (a), (b)); *((volatile uint32_t *)(b)) = swpl((volatile uint32_t)(a)); } * byteswap value and write it to address
*/ */
inline void writel(uint32_t value, uint32_t *address) inline void writel(uint32_t value, uint32_t *address)
{ {
@@ -283,7 +284,7 @@ static void ep_print_int_eds(ohci_t *ohci, char *str)
if (*ed_p == 0) if (*ed_p == 0)
continue; continue;
dbg(__FILE__ ": %s branch int %2d(%2x):", str, i, i); dbg("%s branch int %2d(%2x):\r\n", str, i, i);
while (*ed_p != 0 && j--) while (*ed_p != 0 && j--)
{ {
ed_t *ed = (ed_t *) swpl((uint32_t) ed_p); ed_t *ed = (ed_t *) swpl((uint32_t) ed_p);
@@ -459,9 +460,9 @@ static void ohci_dump(ohci_t *ohci, int verbose)
} }
#endif /* DEBUG_OHCI */ #endif /* DEBUG_OHCI */
/*-------------------------------------------------------------------------* /*
* Interface functions (URB) * Interface functions (URB)
*-------------------------------------------------------------------------*/ */
/* get a transfer request */ /* get a transfer request */
@@ -477,19 +478,25 @@ static int sohci_submit_job(ohci_t *ohci, urb_priv_t *urb, struct devrequest *se
int transfer_len = urb->transfer_buffer_length; int transfer_len = urb->transfer_buffer_length;
int interval = urb->interval; int interval = urb->interval;
/* when controller's hung, permit only roothub cleanup attempts /*
* such as powering down ports */ * when controller's hung, permit only roothub cleanup attempts
* such as powering down ports
*/
if (ohci->disabled) if (ohci->disabled)
{ {
urb_free_priv(purb_priv); // added urb_free_priv(purb_priv); // added
err("sohci_submit_job: EPIPE"); err("sohci_submit_job: EPIPE\r\n");
return -1; return -1;
} }
/* we're about to begin a new transaction here so mark the
* URB unfinished */ /*
* we're about to begin a new transaction here so mark the
* URB unfinished
*/
urb->finished = 0; urb->finished = 0;
/* every endpoint has a ed, locate and fill it */ /* every endpoint has an ed, locate and fill it */
ed = ep_add_ed(ohci, dev, pipe, interval, 1); ed = ep_add_ed(ohci, dev, pipe, interval, 1);
if (!ed) if (!ed)
{ {
@@ -504,9 +511,11 @@ static int sohci_submit_job(ohci_t *ohci, urb_priv_t *urb, struct devrequest *se
case PIPE_BULK: /* one TD for every 4096 Byte */ case PIPE_BULK: /* one TD for every 4096 Byte */
size = (transfer_len - 1) / 4096 + 1; size = (transfer_len - 1) / 4096 + 1;
break; break;
case PIPE_CONTROL:/* 1 TD for setup, 1 for ACK and 1 for every 4096 B */ case PIPE_CONTROL:/* 1 TD for setup, 1 for ACK and 1 for every 4096 B */
size = (transfer_len == 0) ? 2 : (transfer_len - 1) / 4096 + 3; size = (transfer_len == 0) ? 2 : (transfer_len - 1) / 4096 + 3;
break; break;
case PIPE_INTERRUPT: /* 1 TD */ case PIPE_INTERRUPT: /* 1 TD */
size = 1; size = 1;
break; break;
@@ -534,7 +543,7 @@ static int sohci_submit_job(ohci_t *ohci, urb_priv_t *urb, struct devrequest *se
{ {
purb_priv->length = i; purb_priv->length = i;
urb_free_priv(purb_priv); urb_free_priv(purb_priv);
err("sohci_submit_job: ENOMEM"); err("sohci_submit_job: ENOMEM\r\n");
return -1; return -1;
} }
} }
@@ -542,7 +551,7 @@ static int sohci_submit_job(ohci_t *ohci, urb_priv_t *urb, struct devrequest *se
if (ed->state == ED_NEW || (ed->state & ED_DEL)) if (ed->state == ED_NEW || (ed->state & ED_DEL))
{ {
urb_free_priv(purb_priv); urb_free_priv(purb_priv);
err("sohci_submit_job: EINVAL"); err("sohci_submit_job: EINVAL\r\n");
return -1; return -1;
} }
@@ -567,9 +576,11 @@ static inline int sohci_return_job(ohci_t *ohci, urb_priv_t *urb)
{ {
writel(OHCI_INTR_WDH, &regs->intrenable); writel(OHCI_INTR_WDH, &regs->intrenable);
readl(&regs->intrenable); /* PCI posting flush */ readl(&regs->intrenable); /* PCI posting flush */
/* call interrupt device routine */ /* call interrupt device routine */
// dbg("irq_handle device %d", urb->dev->devnum); // dbg("irq_handle device %d", urb->dev->devnum);
urb->dev->irq_handle(urb->dev); urb->dev->irq_handle(urb->dev);
writel(OHCI_INTR_WDH, &regs->intrdisable); writel(OHCI_INTR_WDH, &regs->intrdisable);
readl(&regs->intrdisable); /* PCI posting flush */ readl(&regs->intrdisable); /* PCI posting flush */
} }
@@ -602,15 +613,20 @@ static int sohci_get_current_frame_number(ohci_t *ohci, struct usb_device *usb_d
* ED handling functions * ED handling functions
*-------------------------------------------------------------------------*/ *-------------------------------------------------------------------------*/
/* search for the right branch to insert an interrupt ed into the int tree /*
* do some load ballancing; * search for the right branch to insert an interrupt ed into the int tree
* do some load balancing;
* returns the branch and * returns the branch and
* sets the interval to interval = 2^integer (ld (interval)) */ * sets the interval to interval = 2^integer (ld (interval))
*/
static int ep_int_ballance(ohci_t *ohci, int interval, int load) static int ep_int_balance(ohci_t *ohci, int interval, int load)
{ {
int i, branch = 0; int i;
/* search for the least loaded interrupt endpoint int branch = 0;
/*
* search for the least loaded interrupt endpoint
* branch of all 32 branches * branch of all 32 branches
*/ */
for (i = 0; i < 32; i++) for (i = 0; i < 32; i++)
@@ -638,9 +654,11 @@ static int ep_2_n_interval(int inter)
/*-------------------------------------------------------------------------*/ /*-------------------------------------------------------------------------*/
/* the int tree is a binary tree /*
* the int tree is a binary tree
* in order to process it sequentially the indexes of the branches have to * in order to process it sequentially the indexes of the branches have to
* be mapped the mapping reverses the bits of a word of num_bits length */ * be mapped the mapping reverses the bits of a word of num_bits length
*/
static int ep_rev(int num_bits, int word) static int ep_rev(int num_bits, int word)
{ {
int i; int i;
@@ -648,6 +666,7 @@ static int ep_rev(int num_bits, int word)
for (i = 0; i < num_bits; i++) for (i = 0; i < num_bits; i++)
wout |= (((word >> i) & 1) << (num_bits - i - 1)); wout |= (((word >> i) & 1) << (num_bits - i - 1));
return wout; return wout;
} }
@@ -706,7 +725,7 @@ static int ep_link(ohci_t *ohci, ed_t *edi)
load = ed->int_load; load = ed->int_load;
interval = ep_2_n_interval(ed->int_period); interval = ep_2_n_interval(ed->int_period);
ed->int_interval = interval; ed->int_interval = interval;
int_branch = ep_int_ballance(ohci, interval, load); int_branch = ep_int_balance(ohci, interval, load);
ed->int_branch = int_branch; ed->int_branch = int_branch;
for (i = 0; i < ep_rev(6, interval); i += inter) for (i = 0; i < ep_rev(6, interval); i += inter)
{ {
@@ -745,10 +764,12 @@ static void periodic_unlink(struct ohci *ohci, volatile struct ed *ed, unsigned
} }
} }
/* unlink an ed from one of the HC chains. /*
* unlink an ed from one of the HC chains.
* just the link to the ed is unlinked. * just the link to the ed is unlinked.
* the link from the ed still points to another operational ed or 0 * the link from the ed still points to another operational ed or 0
* so the HC can eventually finish the processing of the unlinked ed */ * so the HC can eventually finish the processing of the unlinked ed
*/
static int ep_unlink(ohci_t *ohci, ed_t *edi) static int ep_unlink(ohci_t *ohci, ed_t *edi)
{ {
@@ -788,6 +809,7 @@ static int ep_unlink(ohci_t *ohci, ed_t *edi)
} }
else else
ed->ed_prev->hwNextED = ed->hwNextED; ed->ed_prev->hwNextED = ed->hwNextED;
if (ohci->ed_bulktail == ed) if (ohci->ed_bulktail == ed)
ohci->ed_bulktail = ed->ed_prev; ohci->ed_bulktail = ed->ed_prev;
else else
@@ -806,7 +828,8 @@ static int ep_unlink(ohci_t *ohci, ed_t *edi)
/*-------------------------------------------------------------------------*/ /*-------------------------------------------------------------------------*/
/* add/reinit an endpoint; this should be done once at the /*
* add/reinit an endpoint; this should be done once at the
* usb_set_configuration command, but the USB stack is a little bit * usb_set_configuration command, but the USB stack is a little bit
* stateless so we do it at every transaction if the state of the ed * stateless so we do it at every transaction if the state of the ed
* is ED_NEW then a dummy td is added and the state is changed to * is ED_NEW then a dummy td is added and the state is changed to
@@ -1835,8 +1858,6 @@ static int hc_start(ohci_t *ohci)
return 0; return 0;
} }
/*-------------------------------------------------------------------------*/
static void flush_data_cache(ohci_t *ohci) static void flush_data_cache(ohci_t *ohci)
{ {
/* flush caches here */ /* flush caches here */
@@ -1924,9 +1945,14 @@ static int hc_interrupt(ohci_t *ohci)
(void) status; (void) status;
err("OHCI Unrecoverable Error, controller usb-%s-%c disabled\r\n(SR:0x%04X%s%s%s%s%s%s)", ohci->slot_name, (char)ohci->controller + '0', status & 0xFFFF, err("OHCI Unrecoverable Error, controller usb-%s-%c disabled\r\n(SR:0x%04X%s%s%s%s%s%s)",
status & 0x8000 ? ", Parity error" : "", status & 0x4000 ? ", Signaled system error" : "", status & 0x2000 ? ", Received master abort" : "", ohci->slot_name, (char)ohci->controller + '0', status & 0xFFFF,
status & 0x1000 ? ", Received target abort" : "", status & 0x800 ? ", Signaled target abort" : "", status & 0x100 ? ", Data parity error" : ""); status & 0x8000 ? ", Parity error" : "",
status & 0x4000 ? ", Signaled system error" : "",
status & 0x2000 ? ", Received master abort" : "",
status & 0x1000 ? ", Received target abort" : "",
status & 0x800 ? ", Signaled target abort" : "",
status & 0x100 ? ", Data parity error" : "");
ohci->disabled++; ohci->disabled++;
#ifdef DEBUG_OHCI #ifdef DEBUG_OHCI
ohci_dump(ohci, 1); ohci_dump(ohci, 1);
@@ -1947,6 +1973,7 @@ static int hc_interrupt(ohci_t *ohci)
writel(OHCI_INTR_WDH, &regs->intrdisable); writel(OHCI_INTR_WDH, &regs->intrdisable);
(void) readl(&regs->intrdisable); /* flush */ (void) readl(&regs->intrdisable); /* flush */
stat = dl_done_list(ohci); stat = dl_done_list(ohci);
writel(OHCI_INTR_WDH, &regs->intrenable); writel(OHCI_INTR_WDH, &regs->intrenable);
(void) readl(&regs->intrdisable); /* flush */ (void) readl(&regs->intrdisable); /* flush */
} }
@@ -1962,6 +1989,7 @@ static int hc_interrupt(ohci_t *ohci)
if (ints & OHCI_INTR_SF) if (ints & OHCI_INTR_SF)
{ {
unsigned int frame = swpw(ohci->hcca->frame_no) & 1; unsigned int frame = swpw(ohci->hcca->frame_no) & 1;
if (ohci->irq) if (ohci->irq)
wait(1 * 1000); wait(1 * 1000);
writel(OHCI_INTR_SF, &regs->intrdisable); writel(OHCI_INTR_SF, &regs->intrdisable);
@@ -1979,16 +2007,19 @@ static int handle_usb_interrupt(ohci_t *ohci)
{ {
if (!ohci->irq_enabled) if (!ohci->irq_enabled)
return 0; return 0;
flush_data_cache(ohci); flush_data_cache(ohci);
ohci->irq = 0; ohci->irq = 0;
ohci->stat_irq = hc_interrupt(ohci); ohci->stat_irq = hc_interrupt(ohci);
ohci->irq = -1; ohci->irq = -1;
return 1; /* clear interrupt, 0: disable interrupt */ return 1; /* clear interrupt, 0: disable interrupt */
} }
void ohci_usb_enable_interrupt(int enable) void ohci_usb_enable_interrupt(int enable)
{ {
int i; int i;
dbg("usb_enable_interrupt(%d)", enable); dbg("usb_enable_interrupt(%d)", enable);
for (i = 0; i < (sizeof(gohci) / sizeof(ohci_t)); i++) for (i = 0; i < (sizeof(gohci) / sizeof(ohci_t)); i++)
{ {
@@ -2005,10 +2036,6 @@ void ohci_usb_enable_interrupt(int enable)
#endif /* !CONFIG_USB_INTERRUPT_POLLING */ #endif /* !CONFIG_USB_INTERRUPT_POLLING */
/*-------------------------------------------------------------------------*/
/*-------------------------------------------------------------------------*/
/* De-allocate all resources.. */ /* De-allocate all resources.. */
static void hc_release_ohci(ohci_t *ohci) static void hc_release_ohci(ohci_t *ohci)
@@ -2037,7 +2064,6 @@ static void hc_free_buffers(ohci_t *ohci)
} }
} }
/*-------------------------------------------------------------------------*/
/* /*
* low level initalisation routine, called from usb.c * low level initalisation routine, called from usb.c
*/ */
@@ -2107,12 +2133,22 @@ int ohci_usb_lowlevel_init(int32_t handle, const struct pci_device_id *ent, void
unsigned short flags; unsigned short flags;
do do
{ {
dbg("\r\nPCI USB descriptors (at %p): flags 0x%04x start 0x%08lx \r\n offset 0x%08lx dmaoffset 0x%08lx length 0x%08lx\r\n", pci_rsc_desc, dbg("\r\nPCI USB descriptors (at %p): flags 0x%04x start 0x%08lx \r\n offset 0x%08lx dmaoffset 0x%08lx length 0x%08lx\r\n",
pci_rsc_desc->flags, pci_rsc_desc->start, pci_rsc_desc->offset, pci_rsc_desc->dmaoffset, pci_rsc_desc->length); pci_rsc_desc,
pci_rsc_desc->flags,
pci_rsc_desc->start,
pci_rsc_desc->offset,
pci_rsc_desc->dmaoffset,
pci_rsc_desc->length);
if (!(pci_rsc_desc->flags & FLG_IO)) if (!(pci_rsc_desc->flags & FLG_IO))
{ {
/* if this is a memory-mapped resource */
if (usb_base_addr == 0xFFFFFFFF) if (usb_base_addr == 0xFFFFFFFF)
{ {
/* and if its not initialized yet */
usb_base_addr = pci_rsc_desc->start; usb_base_addr = pci_rsc_desc->start;
ohci->offset = pci_rsc_desc->offset; ohci->offset = pci_rsc_desc->offset;
ohci->regs = (void *) (pci_rsc_desc->offset + pci_rsc_desc->start); ohci->regs = (void *) (pci_rsc_desc->offset + pci_rsc_desc->start);
@@ -2122,7 +2158,7 @@ int ohci_usb_lowlevel_init(int32_t handle, const struct pci_device_id *ent, void
if ((pci_rsc_desc->flags & FLG_ENDMASK) == ORD_MOTOROLA) if ((pci_rsc_desc->flags & FLG_ENDMASK) == ORD_MOTOROLA)
ohci->big_endian = 0; /* host bridge make swapping intel -> motorola */ ohci->big_endian = 0; /* host bridge make swapping intel -> motorola */
else else
ohci->big_endian = 1; /* driver must swapping intel -> motorola */ ohci->big_endian = 1; /* driver must do swapping intel -> motorola */
} }
} }
flags = pci_rsc_desc->flags; flags = pci_rsc_desc->flags;
@@ -2133,14 +2169,15 @@ int ohci_usb_lowlevel_init(int32_t handle, const struct pci_device_id *ent, void
else else
{ {
hc_free_buffers(ohci); hc_free_buffers(ohci);
dbg("pci_get_resource() failed in %s %s\r\n", __FILE__, __LINE__); dbg("pci_get_resource() failed\r\n");
return(-1); /* get_resource error */
return -1; /* get_resource error */
} }
if (usb_base_addr == 0xFFFFFFFF) if (usb_base_addr == 0xFFFFFFFF)
{ {
hc_free_buffers(ohci); hc_free_buffers(ohci);
return(-1); return -1;
} }
if (handle && (ent != NULL)) if (handle && (ent != NULL))
@@ -2148,20 +2185,36 @@ int ohci_usb_lowlevel_init(int32_t handle, const struct pci_device_id *ent, void
ohci->flags = 0; ohci->flags = 0;
switch (ent->vendor) switch (ent->vendor)
{ {
case PCI_VENDOR_ID_AL: ohci->slot_name = "uli1575"; break; case PCI_VENDOR_ID_AL:
case PCI_VENDOR_ID_NEC: ohci->slot_name = "uPD720101"; ohci->flags |= OHCI_FLAGS_NEC; break; ohci->slot_name = "uli1575";
case PCI_VENDOR_ID_PHILIPS: ohci->slot_name = "isp1561"; break; break;
default: ohci->slot_name = "generic"; break;
case PCI_VENDOR_ID_NEC:
ohci->slot_name = "uPD720101";
ohci->flags |= OHCI_FLAGS_NEC;
break;
case PCI_VENDOR_ID_PHILIPS:
ohci->slot_name = "isp1561";
break;
default:
ohci->slot_name = "generic";
break;
} }
} }
dbg("OHCI usb-%s-%c, regs address 0x%08X, PCI handle 0x%X\r\n", ohci->slot_name, (char)ohci->controller + '0', ohci->regs, handle); dbg("OHCI usb-%s-%c, regs address 0x%08X, PCI handle 0x%X\r\n",
ohci->slot_name,
(char) ohci->controller + '0',
ohci->regs, handle);
if (hc_reset(ohci) < 0) if (hc_reset(ohci) < 0)
{ {
err("Can't reset OHCI usb-%s-%c", ohci->slot_name, (char) ohci->controller + '0'); err("Can't reset OHCI usb-%s-%c", ohci->slot_name, (char) ohci->controller + '0');
hc_release_ohci(ohci); hc_release_ohci(ohci);
hc_free_buffers(ohci); hc_free_buffers(ohci);
return(-1); return -1;
} }
if (hc_start(ohci) < 0) if (hc_start(ohci) < 0)
@@ -2169,8 +2222,9 @@ int ohci_usb_lowlevel_init(int32_t handle, const struct pci_device_id *ent, void
err("Can't start OHCI usb-%s-%c", ohci->slot_name, (char) ohci->controller + '0'); err("Can't start OHCI usb-%s-%c", ohci->slot_name, (char) ohci->controller + '0');
hc_release_ohci(ohci); hc_release_ohci(ohci);
hc_free_buffers(ohci); hc_free_buffers(ohci);
/* Initialization failed */ /* Initialization failed */
return(-1); return -1;
} }
#ifdef DEBUG_OHCI #ifdef DEBUG_OHCI
@@ -2179,18 +2233,21 @@ int ohci_usb_lowlevel_init(int32_t handle, const struct pci_device_id *ent, void
pci_hook_interrupt(handle, handle_usb_interrupt, ohci); pci_hook_interrupt(handle, handle_usb_interrupt, ohci);
if (priv != NULL) if (priv != NULL)
*priv = (void *) ohci; *priv = (void *) ohci;
ohci_inited = 1; ohci_inited = 1;
return(0);
return 0;
} }
int ohci_usb_lowlevel_stop(void *priv) int ohci_usb_lowlevel_stop(void *priv)
{ {
/* this gets called really early - before the controller has */ /* this gets called really early - before the controller has */
/* even been initialized! */ /* even been initialized! */
ohci_t *ohci = (ohci_t *) priv; ohci_t *ohci = (ohci_t *) priv;
if (!ohci_inited) if (!ohci_inited)
return(0); return 0;
if (ohci == NULL) if (ohci == NULL)
ohci = &gohci[0]; ohci = &gohci[0];
@@ -2199,9 +2256,12 @@ int ohci_usb_lowlevel_stop(void *priv)
hc_reset(ohci); hc_reset(ohci);
hc_free_buffers(ohci); hc_free_buffers(ohci);
/* This driver is no longer initialised. It needs a new low-level /* This driver is no longer initialised. It needs a new low-level
* init (board/cpu) before it can be used again. */ * init (board/cpu) before it can be used again. */
ohci_inited = 0; ohci_inited = 0;
return(0);
return 0;
} }