* implement strstr

* clean up usb_arcotg_dcd_enable


git-svn-id: svn://svn.rockbox.org/rockbox/trunk@14740 a1c6a512-1295-4272-9138-f99709370657
This commit is contained in:
Christian Gmeiner 2007-09-17 23:06:23 +00:00
parent 689d5fd446
commit 2077cebca0
3 changed files with 142 additions and 100 deletions

View File

@ -53,6 +53,7 @@ common/strncmp.c
common/strncpy.c
common/strrchr.c
common/strtok.c
common/strstr.c
common/structec.c
common/timefuncs.c
common/unicode.c

45
firmware/common/strstr.c Normal file
View File

@ -0,0 +1,45 @@
/***************************************************************************
* __________ __ ___.
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
* \/ \/ \/ \/ \/
* $Id: $
*
* Copyright (C) 2007 by Christian Gmeiner
*
****************************************************************************/
#include <string.h>
/**
* Locate substring.
* @param search c string to be scanned.
* @param find c string containing the sequence of characters to match.
* @return a pointer to the first occurrence in search of any of the
* entire sequence of characters specified in find, or a
* null pointer if the sequence is not present in search.
*/
char *strstr(const char *search, const char *find)
{
char *hend;
char *a, *b;
if (*find == 0) return (char*)search;
hend = (char *)search + strlen(search) - strlen(find) + 1;
while (search < hend) {
if (*search == *find) {
a = (char *)search;
b = (char *)find;
for (;;) {
if (*b == 0) return (char*)search;
if (*a++ != *b++) {
break;
}
}
}
search++;
}
return 0;
}

View File

@ -523,29 +523,11 @@ int usb_arcotg_dcd_enable(struct usb_ep* ep,
max = desc->wMaxPacketSize;
retval = -EINVAL;
/* check the max package size validate for this endpoint */
/* Refer to USB2.0 spec table 9-13. */
/* check the max package size validate for this endpoint
* Refer to USB2.0 spec table 9-13, */
switch (desc->bmAttributes & 0x03) {
case USB_ENDPOINT_XFER_BULK:
zlt = 1;
break;
case USB_ENDPOINT_XFER_INT:
zlt = 1;
break;
case USB_ENDPOINT_XFER_ISOC:
break;
case USB_ENDPOINT_XFER_CONTROL:
zlt = 1;
break;
}
#if 0
switch (ep->desc->bmAttributes & 0x03) {
case USB_ENDPOINT_XFER_BULK:
if (strstr(ep->ep.name, "-iso") || strstr(ep->ep.name, "-int")) {
if (strstr(ep->name, "-iso") || strstr(ep->name, "-int")) {
goto en_done;
}
mult = 0;
@ -565,85 +547,98 @@ int usb_arcotg_dcd_enable(struct usb_ep* ep,
case 64:
break;
default:
+ case USB_SPEED_LOW:
+ goto en_done;
+ }
+ }
+ break;
+ case USB_ENDPOINT_XFER_INT:
+ if (strstr(ep->ep.name, "-iso")) /* bulk is ok */
+ goto en_done;
+ mult = 0;
+ zlt = 1;
+ switch (udc->gadget.speed) {
+ case USB_SPEED_HIGH:
+ if (max <= 1024)
+ break;
+ case USB_SPEED_FULL:
+ if (max <= 64)
+ break;
+ default:
+ if (max <= 8)
+ break;
+ goto en_done;
+ }
+ break;
+ case USB_ENDPOINT_XFER_ISOC:
+ if (strstr(ep->ep.name, "-bulk") || strstr(ep->ep.name, "-int"))
+ goto en_done;
+ mult = (unsigned char)
+ (1 + ((le16_to_cpu(desc->wMaxPacketSize) >> 11) & 0x03));
+ zlt = 0;
+ switch (udc->gadget.speed) {
+ case USB_SPEED_HIGH:
+ if (max <= 1024)
+ break;
+ case USB_SPEED_FULL:
+ if (max <= 1023)
+ break;
+ default:
+ goto en_done;
+ }
+ break;
+ case USB_ENDPOINT_XFER_CONTROL:
+ if (strstr(ep->ep.name, "-iso") || strstr(ep->ep.name, "-int"))
+ goto en_done;
+ mult = 0;
+ zlt = 1;
+ switch (udc->gadget.speed) {
+ case USB_SPEED_HIGH:
+ case USB_SPEED_FULL:
+ switch (max) {
+ case 1:
+ case 2:
+ case 4:
+ case 8:
+ case 16:
+ case 32:
+ case 64:
+ break;
+ default:
+ goto en_done;
+ }
+ case USB_SPEED_LOW:
+ switch (max) {
+ case 1:
+ case 2:
+ case 4:
+ case 8:
+ break;
+ default:
+ goto en_done;
+ }
+ default:
+ goto en_done;
+ }
+ break;
+
+ default:
+ goto en_done;
+ }
#endif
case USB_SPEED_LOW:
goto en_done;
}
}
break;
case USB_ENDPOINT_XFER_INT:
if (strstr(ep->name, "-iso")) { /* bulk is ok */
goto en_done;
}
mult = 0;
zlt = 1;
switch (arcotg_dcd.speed) {
case USB_SPEED_HIGH:
if (max <= 1024) {
break;
}
case USB_SPEED_FULL:
if (max <= 64) {
break;
}
default:
if (max <= 8) {
break;
}
goto en_done;
}
break;
case USB_ENDPOINT_XFER_ISOC:
if (strstr(ep->name, "-bulk") || strstr(ep->name, "-int")) {
goto en_done;
}
mult = (unsigned char) (1 +((desc->wMaxPacketSize >> 11) & 0x03));
zlt = 0;
switch (arcotg_dcd.speed) {
case USB_SPEED_HIGH:
if (max <= 1024) {
break;
}
case USB_SPEED_FULL:
if (max <= 1023) {
break;
}
default:
goto en_done;
}
break;
case USB_ENDPOINT_XFER_CONTROL:
if (strstr(ep->name, "-iso") || strstr(ep->name, "-int")) {
goto en_done;
}
mult = 0;
zlt = 1;
switch (arcotg_dcd.speed) {
case USB_SPEED_HIGH:
case USB_SPEED_FULL:
switch (max) {
case 1:
case 2:
case 4:
case 8:
case 16:
case 32:
case 64:
break;
default:
goto en_done;
}
case USB_SPEED_LOW:
switch (max) {
case 1:
case 2:
case 4:
case 8:
break;
default:
goto en_done;
}
default:
goto en_done;
}
break;
default:
goto en_done;
}
/* here initialize variable of ep */
ep->maxpacket = max;
@ -690,6 +685,7 @@ int usb_arcotg_dcd_enable(struct usb_ep* ep,
(desc->bEndpointAddress & USB_DIR_IN) ? "in" : "out", val);
logf(" maxpacket %d", max);
en_done:
return retval;
}