mirror of
https://github.com/Fishwaldo/u-boot.git
synced 2025-03-31 03:21:32 +00:00
Fix some endianness issues related to the generic ohci driver
This commit is contained in:
parent
7b59b3c7a8
commit
ae3b770e4e
3 changed files with 66 additions and 18 deletions
|
@ -62,15 +62,20 @@
|
||||||
#include <usb.h>
|
#include <usb.h>
|
||||||
#include "usb_ohci.h"
|
#include "usb_ohci.h"
|
||||||
|
|
||||||
#undef S3C24X0_merge
|
#define S3C24X0_merge
|
||||||
|
|
||||||
#if defined(CONFIG_ARM920T) || \
|
#if defined(CONFIG_ARM920T) || \
|
||||||
defined(CONFIG_S3C2400) || \
|
defined(CONFIG_S3C2400) || \
|
||||||
defined(CONFIG_S3C2410)
|
defined(CONFIG_S3C2410) || \
|
||||||
|
defined(CONFIG_440EP) || \
|
||||||
|
defined(CONFIG_MPC5200)
|
||||||
# define OHCI_USE_NPS /* force NoPowerSwitching mode */
|
# define OHCI_USE_NPS /* force NoPowerSwitching mode */
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#undef OHCI_VERBOSE_DEBUG /* not always helpful */
|
#undef OHCI_VERBOSE_DEBUG /* not always helpful */
|
||||||
|
#undef DEBUG
|
||||||
|
#undef SHOW_INFO
|
||||||
|
#undef OHCI_FILL_TRACE
|
||||||
|
|
||||||
/* For initializing controller (mask in an HCFS mode too) */
|
/* For initializing controller (mask in an HCFS mode too) */
|
||||||
#define OHCI_CONTROL_INIT \
|
#define OHCI_CONTROL_INIT \
|
||||||
|
@ -95,8 +100,13 @@
|
||||||
#define info(format, arg...) do {} while(0)
|
#define info(format, arg...) do {} while(0)
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#define m16_swap(x) swap_16(x)
|
#if defined(CONFIG_440EP) || defined(CONFIG_MPC5200)
|
||||||
#define m32_swap(x) swap_32(x)
|
# define m16_swap(x) (x)
|
||||||
|
# define m32_swap(x) (x)
|
||||||
|
#else
|
||||||
|
# define m16_swap(x) swap_16(x)
|
||||||
|
# define m32_swap(x) swap_32(x)
|
||||||
|
#endif
|
||||||
|
|
||||||
/* global ohci_t */
|
/* global ohci_t */
|
||||||
static ohci_t gohci;
|
static ohci_t gohci;
|
||||||
|
@ -523,7 +533,7 @@ static int ep_link (ohci_t *ohci, ed_t *edi)
|
||||||
if (ohci->ed_controltail == NULL) {
|
if (ohci->ed_controltail == NULL) {
|
||||||
writel (ed, &ohci->regs->ed_controlhead);
|
writel (ed, &ohci->regs->ed_controlhead);
|
||||||
} else {
|
} else {
|
||||||
ohci->ed_controltail->hwNextED = m32_swap (ed);
|
ohci->ed_controltail->hwNextED = m32_swap ((unsigned long)ed);
|
||||||
}
|
}
|
||||||
ed->ed_prev = ohci->ed_controltail;
|
ed->ed_prev = ohci->ed_controltail;
|
||||||
if (!ohci->ed_controltail && !ohci->ed_rm_list[0] &&
|
if (!ohci->ed_controltail && !ohci->ed_rm_list[0] &&
|
||||||
|
@ -539,7 +549,7 @@ static int ep_link (ohci_t *ohci, ed_t *edi)
|
||||||
if (ohci->ed_bulktail == NULL) {
|
if (ohci->ed_bulktail == NULL) {
|
||||||
writel (ed, &ohci->regs->ed_bulkhead);
|
writel (ed, &ohci->regs->ed_bulkhead);
|
||||||
} else {
|
} else {
|
||||||
ohci->ed_bulktail->hwNextED = m32_swap (ed);
|
ohci->ed_bulktail->hwNextED = m32_swap ((unsigned long)ed);
|
||||||
}
|
}
|
||||||
ed->ed_prev = ohci->ed_bulktail;
|
ed->ed_prev = ohci->ed_bulktail;
|
||||||
if (!ohci->ed_bulktail && !ohci->ed_rm_list[0] &&
|
if (!ohci->ed_bulktail && !ohci->ed_rm_list[0] &&
|
||||||
|
@ -635,7 +645,7 @@ static ed_t * ep_add_ed (struct usb_device *usb_dev, unsigned long pipe)
|
||||||
ed->hwINFO = m32_swap (OHCI_ED_SKIP); /* skip ed */
|
ed->hwINFO = m32_swap (OHCI_ED_SKIP); /* skip ed */
|
||||||
/* dummy td; end of td list for ed */
|
/* dummy td; end of td list for ed */
|
||||||
td = td_alloc (usb_dev);
|
td = td_alloc (usb_dev);
|
||||||
ed->hwTailP = m32_swap (td);
|
ed->hwTailP = m32_swap ((unsigned long)td);
|
||||||
ed->hwHeadP = ed->hwTailP;
|
ed->hwHeadP = ed->hwTailP;
|
||||||
ed->state = ED_UNLINK;
|
ed->state = ED_UNLINK;
|
||||||
ed->type = usb_pipetype (pipe);
|
ed->type = usb_pipetype (pipe);
|
||||||
|
@ -693,12 +703,12 @@ static void td_fill (ohci_t *ohci, unsigned int info,
|
||||||
data = 0;
|
data = 0;
|
||||||
|
|
||||||
td->hwINFO = m32_swap (info);
|
td->hwINFO = m32_swap (info);
|
||||||
td->hwCBP = m32_swap (data);
|
td->hwCBP = m32_swap ((unsigned long)data);
|
||||||
if (data)
|
if (data)
|
||||||
td->hwBE = m32_swap (data + len - 1);
|
td->hwBE = m32_swap ((unsigned long)(data + len - 1));
|
||||||
else
|
else
|
||||||
td->hwBE = 0;
|
td->hwBE = 0;
|
||||||
td->hwNextTD = m32_swap (td_pt);
|
td->hwNextTD = m32_swap ((unsigned long)td_pt);
|
||||||
#ifndef S3C24X0_merge
|
#ifndef S3C24X0_merge
|
||||||
td->hwPSW [0] = m16_swap (((__u32)data & 0x0FFF) | 0xE000);
|
td->hwPSW [0] = m16_swap (((__u32)data & 0x0FFF) | 0xE000);
|
||||||
#endif
|
#endif
|
||||||
|
@ -875,7 +885,12 @@ static int dl_done_list (ohci_t *ohci, td_t *td_list)
|
||||||
/* see if this done list makes for all TD's of current URB,
|
/* see if this done list makes for all TD's of current URB,
|
||||||
* and mark the URB finished if so */
|
* and mark the URB finished if so */
|
||||||
if (++(lurb_priv->td_cnt) == lurb_priv->length) {
|
if (++(lurb_priv->td_cnt) == lurb_priv->length) {
|
||||||
|
#if 1
|
||||||
|
if ((ed->state & (ED_OPER | ED_UNLINK)) &&
|
||||||
|
(lurb_priv->state != URB_DEL))
|
||||||
|
#else
|
||||||
if ((ed->state & (ED_OPER | ED_UNLINK)))
|
if ((ed->state & (ED_OPER | ED_UNLINK)))
|
||||||
|
#endif
|
||||||
urb_finished = 1;
|
urb_finished = 1;
|
||||||
else
|
else
|
||||||
dbg("dl_done_list: strange.., ED state %x, ed->state\n");
|
dbg("dl_done_list: strange.., ED state %x, ed->state\n");
|
||||||
|
@ -1068,9 +1083,15 @@ pkt_print(dev, pipe, buffer, transfer_len, cmd, "SUB(rh)", usb_pipein(pipe));
|
||||||
}
|
}
|
||||||
|
|
||||||
bmRType_bReq = cmd->requesttype | (cmd->request << 8);
|
bmRType_bReq = cmd->requesttype | (cmd->request << 8);
|
||||||
|
#if defined(CONFIG_440EP) || defined(CONFIG_MPC5200)
|
||||||
|
wValue = __swap_16(cmd->value);
|
||||||
|
wIndex = __swap_16(cmd->index);
|
||||||
|
wLength = __swap_16(cmd->length);
|
||||||
|
#else
|
||||||
wValue = m16_swap (cmd->value);
|
wValue = m16_swap (cmd->value);
|
||||||
wIndex = m16_swap (cmd->index);
|
wIndex = m16_swap (cmd->index);
|
||||||
wLength = m16_swap (cmd->length);
|
wLength = m16_swap (cmd->length);
|
||||||
|
#endif /* CONFIG_440EP || CONFIG_MPC5200 */
|
||||||
|
|
||||||
info("Root-Hub: adr: %2x cmd(%1x): %08x %04x %04x %04x",
|
info("Root-Hub: adr: %2x cmd(%1x): %08x %04x %04x %04x",
|
||||||
dev->devnum, 8, bmRType_bReq, wValue, wIndex, wLength);
|
dev->devnum, 8, bmRType_bReq, wValue, wIndex, wLength);
|
||||||
|
@ -1084,6 +1105,20 @@ pkt_print(dev, pipe, buffer, transfer_len, cmd, "SUB(rh)", usb_pipein(pipe));
|
||||||
RH_OTHER | RH_CLASS almost ever means HUB_PORT here
|
RH_OTHER | RH_CLASS almost ever means HUB_PORT here
|
||||||
*/
|
*/
|
||||||
|
|
||||||
|
#if defined(CONFIG_440EP) || defined(CONFIG_MPC5200)
|
||||||
|
case RH_GET_STATUS:
|
||||||
|
*(__u16 *) data_buf = __swap_16(1); OK (2);
|
||||||
|
case RH_GET_STATUS | RH_INTERFACE:
|
||||||
|
*(__u16 *) data_buf = __swap_16(0); OK (2);
|
||||||
|
case RH_GET_STATUS | RH_ENDPOINT:
|
||||||
|
*(__u16 *) data_buf = __swap_16(0); OK (2);
|
||||||
|
case RH_GET_STATUS | RH_CLASS:
|
||||||
|
*(__u32 *) data_buf = __swap_32(
|
||||||
|
RD_RH_STAT & ~(RH_HS_CRWE | RH_HS_DRWE));
|
||||||
|
OK (4);
|
||||||
|
case RH_GET_STATUS | RH_OTHER | RH_CLASS:
|
||||||
|
*(__u32 *) data_buf = __swap_32(RD_RH_PORTSTAT); OK (4);
|
||||||
|
#else
|
||||||
case RH_GET_STATUS:
|
case RH_GET_STATUS:
|
||||||
*(__u16 *) data_buf = m16_swap (1); OK (2);
|
*(__u16 *) data_buf = m16_swap (1); OK (2);
|
||||||
case RH_GET_STATUS | RH_INTERFACE:
|
case RH_GET_STATUS | RH_INTERFACE:
|
||||||
|
@ -1096,6 +1131,7 @@ pkt_print(dev, pipe, buffer, transfer_len, cmd, "SUB(rh)", usb_pipein(pipe));
|
||||||
OK (4);
|
OK (4);
|
||||||
case RH_GET_STATUS | RH_OTHER | RH_CLASS:
|
case RH_GET_STATUS | RH_OTHER | RH_CLASS:
|
||||||
*(__u32 *) data_buf = m32_swap (RD_RH_PORTSTAT); OK (4);
|
*(__u32 *) data_buf = m32_swap (RD_RH_PORTSTAT); OK (4);
|
||||||
|
#endif /* CONFIG_440EP || CONFIG_MPC5200 */
|
||||||
|
|
||||||
case RH_CLEAR_FEATURE | RH_ENDPOINT:
|
case RH_CLEAR_FEATURE | RH_ENDPOINT:
|
||||||
switch (wValue) {
|
switch (wValue) {
|
||||||
|
@ -1294,8 +1330,10 @@ int submit_common_msg(struct usb_device *dev, unsigned long pipe, void *buffer,
|
||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#if 0
|
||||||
wait_ms(10);
|
wait_ms(10);
|
||||||
/* ohci_dump_status(&gohci); */
|
/* ohci_dump_status(&gohci); */
|
||||||
|
#endif
|
||||||
|
|
||||||
/* allow more time for a BULK device to react - some are slow */
|
/* allow more time for a BULK device to react - some are slow */
|
||||||
#define BULK_TO 5000 /* timeout in milliseconds */
|
#define BULK_TO 5000 /* timeout in milliseconds */
|
||||||
|
@ -1337,6 +1375,7 @@ int submit_common_msg(struct usb_device *dev, unsigned long pipe, void *buffer,
|
||||||
err("CTL:TIMEOUT ");
|
err("CTL:TIMEOUT ");
|
||||||
#ifdef S3C24X0_merge
|
#ifdef S3C24X0_merge
|
||||||
dbg("submit_common_msg: TO status %x\n", stat);
|
dbg("submit_common_msg: TO status %x\n", stat);
|
||||||
|
stat = USB_ST_CRC_ERR;
|
||||||
urb_finished = 1;
|
urb_finished = 1;
|
||||||
#endif
|
#endif
|
||||||
stat = USB_ST_CRC_ERR;
|
stat = USB_ST_CRC_ERR;
|
||||||
|
@ -1755,5 +1794,4 @@ int usb_lowlevel_stop(void)
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
#endif /* CONFIG_USB_OHCI_NEW */
|
#endif /* CONFIG_USB_OHCI_NEW */
|
||||||
|
|
|
@ -94,9 +94,16 @@
|
||||||
|
|
||||||
/* USB */
|
/* USB */
|
||||||
#if 1
|
#if 1
|
||||||
#define CONFIG_USB_OHCI
|
#define CONFIG_USB_OHCI_NEW
|
||||||
#define ADD_USB_CMD CFG_CMD_USB | CFG_CMD_FAT
|
#define ADD_USB_CMD CFG_CMD_USB | CFG_CMD_FAT
|
||||||
#define CONFIG_USB_STORAGE
|
#define CONFIG_USB_STORAGE
|
||||||
|
|
||||||
|
#undef CFG_USB_OHCI_BOARD_INIT
|
||||||
|
#define CFG_USB_OHCI_CPU_INIT
|
||||||
|
#define CFG_USB_OHCI_REGS_BASE MPC5XXX_USB
|
||||||
|
#define CFG_USB_OHCI_SLOT_NAME "mpc5200"
|
||||||
|
#define CFG_USB_OHCI_MAX_ROOT_PORTS 15
|
||||||
|
|
||||||
#else
|
#else
|
||||||
#define ADD_USB_CMD 0
|
#define ADD_USB_CMD 0
|
||||||
#endif
|
#endif
|
||||||
|
|
|
@ -230,16 +230,12 @@ int usb_set_interface(struct usb_device *dev, int interface, int alternate);
|
||||||
|
|
||||||
/* big endian -> little endian conversion */
|
/* big endian -> little endian conversion */
|
||||||
/* some CPUs are already little endian e.g. the ARM920T */
|
/* some CPUs are already little endian e.g. the ARM920T */
|
||||||
#ifdef LITTLEENDIAN
|
#define __swap_16(x) \
|
||||||
#define swap_16(x) ((unsigned short)(x))
|
|
||||||
#define swap_32(x) ((unsigned long)(x))
|
|
||||||
#else
|
|
||||||
#define swap_16(x) \
|
|
||||||
({ unsigned short x_ = (unsigned short)x; \
|
({ unsigned short x_ = (unsigned short)x; \
|
||||||
(unsigned short)( \
|
(unsigned short)( \
|
||||||
((x_ & 0x00FFU) << 8) | ((x_ & 0xFF00U) >> 8) ); \
|
((x_ & 0x00FFU) << 8) | ((x_ & 0xFF00U) >> 8) ); \
|
||||||
})
|
})
|
||||||
#define swap_32(x) \
|
#define __swap_32(x) \
|
||||||
({ unsigned long x_ = (unsigned long)x; \
|
({ unsigned long x_ = (unsigned long)x; \
|
||||||
(unsigned long)( \
|
(unsigned long)( \
|
||||||
((x_ & 0x000000FFUL) << 24) | \
|
((x_ & 0x000000FFUL) << 24) | \
|
||||||
|
@ -247,6 +243,13 @@ int usb_set_interface(struct usb_device *dev, int interface, int alternate);
|
||||||
((x_ & 0x00FF0000UL) >> 8) | \
|
((x_ & 0x00FF0000UL) >> 8) | \
|
||||||
((x_ & 0xFF000000UL) >> 24) ); \
|
((x_ & 0xFF000000UL) >> 24) ); \
|
||||||
})
|
})
|
||||||
|
|
||||||
|
#ifdef LITTLEENDIAN
|
||||||
|
# define swap_16(x) (x)
|
||||||
|
# define swap_32(x) (x)
|
||||||
|
#else
|
||||||
|
# define swap_16(x) __swap_16(x)
|
||||||
|
# define swap_32(x) __swap_32(x)
|
||||||
#endif /* LITTLEENDIAN */
|
#endif /* LITTLEENDIAN */
|
||||||
|
|
||||||
/*
|
/*
|
||||||
|
|
Loading…
Add table
Reference in a new issue