floratest5
/
xiuos
forked from xuos/xiuos
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Modify xhci_stop so that the xHCI can adapt to XiZi AIOT

This commit is contained in:
xj 2024-07-01 03:02:01 -07:00
parent e34d688cc3
commit 3efb2335c5
1 changed files with 17 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

23
Ubiquitous/XiZi_AIoT/services/drivers/usb/components/port/xhci/xhci.c
View File

@ -358,18 +358,26 @@ static void xhci_legacy_claim ( struct xhci_host *xhci ) {
return;
/* Claim ownership */
// writeb ( XHCI_USBLEGSUP_OS_OWNED,
// xhci->cap + xhci->legacy + XHCI_USBLEGSUP_OS );
writeb ( XHCI_USBLEGSUP_OS_OWNED,
xhci->cap + xhci->legacy + XHCI_USBLEGSUP_OS );
xhci->cap_addr + xhci->legacy + XHCI_USBLEGSUP_OS );
/* Wait for BIOS to release ownership */
for ( i = 0 ; i < XHCI_USBLEGSUP_MAX_WAIT_MS ; i++ ) {
/* Check if BIOS has released ownership */
bios = readb ( xhci->cap + xhci->legacy + XHCI_USBLEGSUP_BIOS );
// bios = readb ( xhci->cap + xhci->legacy + XHCI_USBLEGSUP_BIOS );
bios = readb ( xhci->cap_addr + xhci->legacy + XHCI_USBLEGSUP_BIOS );
if ( ! ( bios & XHCI_USBLEGSUP_BIOS_OWNED ) ) {
USB_LOG_DBG("XHCI %s claimed ownership from BIOS\n",
xhci->name );
ctlsts = readl ( xhci->cap + xhci->legacy +
// ctlsts = readl ( xhci->cap + xhci->legacy +
// XHCI_USBLEGSUP_CTLSTS );
ctlsts = readl ( xhci->cap_addr + xhci->legacy +
XHCI_USBLEGSUP_CTLSTS );
if ( ctlsts ) {
USB_LOG_DBG("XHCI %s warning: BIOS retained "
@ -428,15 +436,18 @@ static int xhci_stop ( struct xhci_host *xhci ) {
unsigned int i;
/* Clear run/stop bit */
usbcmd = readl ( xhci->op + XHCI_OP_USBCMD );
// usbcmd = readl ( xhci->op + XHCI_OP_USBCMD );
usbcmd = readl ( xhci->op_addr + XHCI_OP_USBCMD );
usbcmd &= ~XHCI_USBCMD_RUN;
writel ( usbcmd, xhci->op + XHCI_OP_USBCMD );
// writel ( usbcmd, xhci->op + XHCI_OP_USBCMD );
writel ( usbcmd, xhci->op_addr + XHCI_OP_USBCMD );
/* Wait for device to stop */
for ( i = 0 ; i < XHCI_STOP_MAX_WAIT_MS ; i++ ) {
/* Check if device is stopped */
usbsts = readl ( xhci->op + XHCI_OP_USBSTS );
// usbsts = readl ( xhci->op + XHCI_OP_USBSTS );
usbsts = readl ( xhci->op_addr + XHCI_OP_USBSTS );
if ( usbsts & XHCI_USBSTS_HCH )
return 0;