📄 hwinit.c
字号:
DEBUGMSG(ZONE_FUNCTION,(L"\tBCTRL2_CLEAR=%x\r\n", INREG16(&cpld->BCTRL2_CLEAR)));
DEBUGMSG(ZONE_FUNCTION,(L"\tBCTRL3_SET=%x\r\n", INREG16(&cpld->BCTRL3_SET)));
DEBUGMSG(ZONE_FUNCTION,(L"\tBCTRL3_CLEAR=%x\r\n", INREG16(&cpld->BCTRL3_CLEAR)));
DEBUGMSG(ZONE_FUNCTION,(L"\tBCTRL4_SET=%x\r\n", INREG16(&cpld->BCTRL4_SET)));
DEBUGMSG(ZONE_FUNCTION,(L"\tBCTRL4_CLEAR=%x\r\n", INREG16(&cpld->BCTRL4_CLEAR)));
DEBUGMSG(ZONE_FUNCTION,(L"\tBSTAT1=%x\r\n", INREG16(&cpld->BSTAT1)));
DEBUGMSG(ZONE_FUNCTION,(L"\tINT_STATUS=%x\r\n", INREG16(&cpld->INT_STATUS)));
DEBUGMSG(ZONE_FUNCTION,(L"\tINT_CUR_STATUS=%x\r\n", INREG16(&cpld->INT_CUR_STATUS)));
DEBUGMSG(ZONE_FUNCTION,(L"\tINT_MASK_SET=%x\r\n", INREG16(&cpld->INT_MASK_SET)));
DEBUGMSG(ZONE_FUNCTION,(L"\tINT_MASK_CLEAR=%x\r\n", INREG16(&cpld->INT_MASK_CLEAR)));
if (org_cpld == NULL)
MmUnmapIoSpace(cpld, sizeof(CSP_PBC_REGS));
}
#endif
//-----------------------------------------------------------------------------
//
// Function: InitializeCPLD
//
// This function is to configure the CPLD to corresponding USB core
//
// Parameters:
// IsHost - TRUE: it is configured as USB Host
// - FALSE: it is configured as USB client
//
// Returns:
// TRUE: Success
// FALSE: Failure
//
//-----------------------------------------------------------------------------
static BOOL InitializeCPLD(BOOL IsHost)
{
volatile PCSP_PBC_REGS cpld;
PHYSICAL_ADDRESS phyAddr;
phyAddr.QuadPart = BSP_BASE_REG_PA_PBC_BASE;
cpld = (PCSP_PBC_REGS) MmMapIoSpace(phyAddr, sizeof(CSP_PBC_REGS), FALSE);
if (cpld == NULL)
{
DEBUGMSG(ZONE_ERROR,
(TEXT("%s(): MmMapIoSpace failed!\r\n"), __WFUNCTION__));
return FALSE;
}
//enble OTG
OUTREG16(&cpld->BCTRL3_SET,(1<<PBC_BCTRL3_USB_OTG_ON_LSH));
OUTREG16(&cpld->BCTRL3_SET,(1<<PBC_BCTRL3_OTG_HS_EN_LSH));
if (IsHost)
OUTREG16(&cpld->BCTRL3_CLEAR,(1<<PBC_BCTRL3_OTG_VBUS_EN_LSH));
OUTREG16(&cpld->BCTRL3_CLEAR,(1<<PBC_BCTRL3_OTG_HS_EN_LSH));
MmUnmapIoSpace(cpld, sizeof(CSP_PBC_REGS));
return TRUE;
}
//-----------------------------------------------------------------------------
//
// Function: DumpDeviceState
//
// This function is to dump the device status
//
// Parameters:
// state - pointer to PORTSC register
//
// Returns:
// NULL
//
//-----------------------------------------------------------------------------
#ifdef DEBUG
static void DumpDeviceState( USB_PORTSC_T * state)
{
if (state->CCS)
DEBUGMSG(ZONE_FUNCTION, (L"\t\tCurrent Connect Status: Attached\r\n"));
if (state->CSC)
DEBUGMSG(ZONE_FUNCTION, (L"\t\tConnect Status Change: Changed\r\n"));
if (state->PE)
DEBUGMSG(ZONE_FUNCTION, (L"\t\tPort Enabled\r\n"));
if (state->PEC)
DEBUGMSG(ZONE_FUNCTION, (L"\t\tPort Enable/Disable Change\r\n"));
if (state->OCA)
DEBUGMSG(ZONE_FUNCTION, (L"\t\tOver-current Active\r\n"));
if (state->OCC)
DEBUGMSG(ZONE_FUNCTION, (L"\t\tOver-current Change\r\n"));
if (state->FPR)
DEBUGMSG(ZONE_FUNCTION, (L"\t\tForce Port Resume\r\n"));
if (state->SUSP)
DEBUGMSG(ZONE_FUNCTION, (L"\t\tSuspend\r\n"));
if (state->PR)
DEBUGMSG(ZONE_FUNCTION, (L"\t\tPort Reset\r\n"));
if (state->HSP)
DEBUGMSG(ZONE_FUNCTION, (L"\t\tHigh-Speed Port \r\n"));
DEBUGMSG(ZONE_FUNCTION, (L"\t\tLine Status: %x", state->LS));
switch (state->LS) {
case 0:
DEBUGMSG(ZONE_FUNCTION, (L"\t\t\tSE0\r\n"));
break;
case 1:
DEBUGMSG(ZONE_FUNCTION, (L"\t\t\tJ-state\r\n"));
break;
case 2:
DEBUGMSG(ZONE_FUNCTION, (L"\t\t\tK-state\r\n"));
break;
case 3:
default:
DEBUGMSG(ZONE_FUNCTION, (L"\t\t\tUndefined\r\n"));
break;
}
if (state->PP)
DEBUGMSG(ZONE_FUNCTION, (L"\t\t??? Should be 0 for device\r\n"));
if (state->PO)
DEBUGMSG(ZONE_FUNCTION, (L"\t\tPort Owner\r\n"));
if (state->PIC) {
DEBUGMSG(ZONE_FUNCTION, (L"\t\tPort Indicator Control"));
switch (state->PIC) {
case 1:
DEBUGMSG(ZONE_FUNCTION, (L"\t\t\tAmber\r\n"));
break;
case 2:
DEBUGMSG(ZONE_FUNCTION, (L"\t\t\tGreen\r\n"));
break;
case 3:
default:
DEBUGMSG(ZONE_FUNCTION, (L"\t\t\tUndefined\r\n"));
break;
}
}
if (state->PTC)
DEBUGMSG(ZONE_FUNCTION, (L"\t\tPort Test Control: %x\r\n", state->PTC));
if (state->WKCN)
DEBUGMSG(ZONE_FUNCTION, (L"\t\tWake on Connect Enable (WKCNNT_E)\r\n"));
if (state->WKDC)
DEBUGMSG(ZONE_FUNCTION, (L"\t\tWake on Disconnect Enable (WKDSCNNT_E) \r\n"));
if (state->WKOC)
DEBUGMSG(ZONE_FUNCTION, (L"\t\tWake on Over-current Enable (WKOC_E) \r\n"));
if (state->PHCD)
DEBUGMSG(ZONE_FUNCTION, (L"\t\tPHY Low Power Suspend - Clock Disable (PLPSCD) \r\n"));
if (state->PFSC)
DEBUGMSG(ZONE_FUNCTION, (L"\t\tPort Force Full Speed Connect \r\n"));
DEBUGMSG(ZONE_FUNCTION, (L"\t\tPort Speed: %x->", state->PSPD));
switch (state->PSPD) {
case 0:
DEBUGMSG(ZONE_FUNCTION, (L"\t\t\tFull Speed\r\n"));
break;
case 1:
DEBUGMSG(ZONE_FUNCTION, (L"\t\t\tLow Speed\r\n"));
break;
case 2:
DEBUGMSG(ZONE_FUNCTION, (L"\t\t\tHigh Speed\r\n"));
break;
case 3:
default:
DEBUGMSG(ZONE_FUNCTION, (L"\t\t\tUndefined\r\n"));
break;
}
DEBUGMSG(ZONE_FUNCTION, (L"\t\tParallel Transceiver Width:%x->", state->PTW));
if (state->PTW)
DEBUGMSG(ZONE_FUNCTION, (L"\t\t\t16 bits\r\n"));
else
DEBUGMSG(ZONE_FUNCTION, (L"\t\t\t8 bits\r\n"));
if (state->STS)
DEBUGMSG(ZONE_FUNCTION, (L"\t\tSerial Transceiver Select \r\n"));
DEBUGMSG(ZONE_FUNCTION, (L"\t\tParallel Transceiver Select:%x->", state->PTS));
switch (state->PTS) {
case 0:
DEBUGMSG(ZONE_FUNCTION, (L"\t\t\tUTMI/UTMI+\r\n"));
break;
case 1:
DEBUGMSG(ZONE_FUNCTION, (L"\t\t\tPhilips Classic\r\n"));
break;
case 2:
DEBUGMSG(ZONE_FUNCTION, (L"\t\t\tULPI\r\n"));
break;
case 3:
DEBUGMSG(ZONE_FUNCTION, (L"\t\t\tSerial/1.1 PHY (FS Only)\r\n"));
break;
default:
DEBUGMSG(ZONE_FUNCTION, (L"\t\t\tUndefined\r\n"));
break;
}
}
#endif
//-----------------------------------------------------------------------------
//
// Function: DumpUSBRegs
//
// This function is to dump the USB OTG Register detail
//
// Parameters:
// regs - Pointer to 3 USB Core Register
//
// Returns:
// NULL
//
//-----------------------------------------------------------------------------
#ifdef DEBUG
void DumpUSBRegs(PCSP_USB_REGS regs)
{
static first=1;
CSP_USB_REG *pReg;
DEBUGMSG(ZONE_FUNCTION, (L"Dump OTG Regs\r\n"));
pReg=(PCSP_USB_REG)(&(regs->OTG));
if (first) {
DEBUGMSG(ZONE_FUNCTION,(L"\tID(%xh)=%x\r\n",offset(CSP_USB_REG,ID), INREG32(&pReg->ID)));
DEBUGMSG(ZONE_FUNCTION,(L"\tHWGENERAL(%xh)=%x\r\n",offset(CSP_USB_REG,HWGENERAL),INREG32(&pReg->HWGENERAL)));
DEBUGMSG(ZONE_FUNCTION,(L"\tHWHOST(%xh)=%x\r\n",offset(CSP_USB_REG,HWHOST),INREG32(&pReg->HWHOST)));
DEBUGMSG(ZONE_FUNCTION,(L"\tHWDEVICE(%xh)=%x\r\n",offset(CSP_USB_REG,HWDEVICE),INREG32(&pReg->HWDEVICE)));
DEBUGMSG(ZONE_FUNCTION,(L"\tHWTXBUF(%xh)=%x\r\n",offset(CSP_USB_REG,HWTXBUF),INREG32(&pReg->HWTXBUF)));
DEBUGMSG(ZONE_FUNCTION,(L"\tHWRXBUF(%xh)=%x\r\n",offset(CSP_USB_REG,HWRXBUF),INREG32(&pReg->HWRXBUF)));
DEBUGMSG(ZONE_FUNCTION,(L"\tCAPLENGTH(%xh)=%x\r\n",offset(CSP_USB_REG,CAPLENGTH),INREG8(&pReg->CAPLENGTH)));
DEBUGMSG(ZONE_FUNCTION,(L"\tHCIVERSION(%xh)=%x\r\n",offset(CSP_USB_REG,HCIVERSION),INREG16(&pReg->HCIVERSION)));
DEBUGMSG(ZONE_FUNCTION,(L"\tHCSPARAMS(%xh)=%x\r\n",offset(CSP_USB_REG,HCSPARAMS),INREG32(&pReg->HCSPARAMS)));
DEBUGMSG(ZONE_FUNCTION,(L"\tHCCPARAMS(%xh)=%x\r\n",offset(CSP_USB_REG,HCCPARAMS),INREG32(&pReg->HCCPARAMS)));
DEBUGMSG(ZONE_FUNCTION,(L"\tDCIVERSION(%xh)=%x\r\n",offset(CSP_USB_REG,DCIVERSION),INREG16(&pReg->DCIVERSION)));
DEBUGMSG(ZONE_FUNCTION,(L"\tDCCPARAMS(%xh)=%x\r\n",offset(CSP_USB_REG,DCCPARAMS),INREG32(&pReg->DCCPARAMS)));
first=0;
}
DEBUGMSG(ZONE_FUNCTION,(L"\tUSBCMD(%xh)=%x\r\n",offset(CSP_USB_REG,USBCMD),INREG32(&pReg->USBCMD)));
DEBUGMSG(ZONE_FUNCTION,(L"\tUSBSTS(%xh)=%x\r\n",offset(CSP_USB_REG,USBSTS),INREG32(&pReg->USBSTS)));
DEBUGMSG(ZONE_FUNCTION,(L"\tUSBINTR(%xh)=%x\r\n",offset(CSP_USB_REG,USBINTR),INREG32(&pReg->USBINTR)));
DEBUGMSG(ZONE_FUNCTION,(L"\tPORTSC(%xh)[0]=%x\r\n",offset(CSP_USB_REG,PORTSC[0]),INREG32(&pReg->PORTSC[0])));
{
USB_PORTSC_T state;
DWORD * temp=(DWORD*)&state;
*temp=INREG32(&pReg->PORTSC[0]);
DumpDeviceState( & state);
}
DEBUGMSG(ZONE_FUNCTION,(L"\tOTGSC(%xh)=%x\r\n",offset(CSP_USB_REG,OTGSC),INREG32(&pReg->OTGSC)));
DEBUGMSG(ZONE_FUNCTION,(L"\tUSBMODE(%xh)=%x\r\n",offset(CSP_USB_REG,USBMODE),INREG32(&pReg->USBMODE)));
DEBUGMSG(ZONE_FUNCTION,(L"\tULPI_VIEWPORT(%xh)=%x\r\n",offset(CSP_USB_REG,ULPI_VIEWPORT),INREG32(&pReg->ULPI_VIEWPORT)));
DEBUGMSG(ZONE_FUNCTION,(L"\t*********************\r\n"));
DEBUGMSG(ZONE_FUNCTION,(L"\tAddress of ASYNCLISTADDR at 0x%x\r\n", &pReg->T_158H.ASYNCLISTADDR));
DEBUGMSG(ZONE_FUNCTION,(L"\tASYNCLISTADDR(%xh)=%x\r\n",offset(CSP_USB_REG,T_158H),INREG32(&pReg->T_158H.ASYNCLISTADDR)));
DEBUGMSG(ZONE_FUNCTION,(L"\tENDPTSETUPSTAT(%xh)=%x\r\n",offset(CSP_USB_REG,ENDPTSETUPSTAT),INREG32(&pReg->ENDPTSETUPSTAT)));
DEBUGMSG(ZONE_FUNCTION,(L"\tENDPTPRIME(%xh)=%x\r\n",offset(CSP_USB_REG,ENDPTPRIME),INREG32(&pReg->ENDPTPRIME)));
DEBUGMSG(ZONE_FUNCTION,(L"\tENDPTFLUSH(%xh)=%x\r\n",offset(CSP_USB_REG,ENDPTFLUSH),INREG32(&pReg->ENDPTFLUSH)));
DEBUGMSG(ZONE_FUNCTION,(L"\tENDPTSTATUS(%xh)=%x\r\n",offset(CSP_USB_REG,ENDPTSTATUS),INREG32(&pReg->ENDPTSTATUS)));
DEBUGMSG(ZONE_FUNCTION,(L"\tENDPTCOMPLETE(%xh)=%x\r\n",offset(CSP_USB_REG,ENDPTCOMPLETE),INREG32(&pReg->ENDPTCOMPLETE)));
DEBUGMSG(ZONE_FUNCTION,(L"\tENDPTCTRL0(%xh)=%x\r\n",offset(CSP_USB_REG,ENDPTCTRL0),INREG32(&pReg->ENDPTCTRL0)));
DEBUGMSG(ZONE_FUNCTION,(L"\t*********************\r\n"));
DEBUGMSG(ZONE_FUNCTION,(L"\tUSB_CTRL(%xh)=%x\r\n",offset(CSP_USB_REGS,USB_CTRL),INREG32(®s->USB_CTRL)));
DEBUGMSG(ZONE_FUNCTION,(L"\tUSB_OTG_MIRROR(%xh)=%x\r\n",offset(CSP_USB_REGS,USB_OTG_MIRROR),INREG32(®s->USB_OTG_MIRROR)));
}
#endif
//-----------------------------------------------------------------------------
//
// Function: ConfigOTGHost
//
// This function is to configure host functionality on the USB OTG Core.
//
// Parameters:
// pRegs - Pointer to 3 USB Core Registers
//
// Returns:
// NULL
//
//-----------------------------------------------------------------------------
static void ConfigOTGHost(CSP_USB_REGS *pRegs)
{
USB_PORTSC_T Portsc;
USB_CTRL_T Ctrl;
DWORD *temp;
//RETAILMSG(1, (TEXT("ConfigOTGHost\r\n")));
//usb_otg_ulpi_interface_configure
temp = (DWORD *)&Portsc;
*temp = INREG32(&pRegs->OTG.PORTSC);
Portsc.LS = LS_J_STATE;
#if (USB_HOST_MODE == 0)
Portsc.PTS = PTS_SERIAL;
#else
Portsc.PTS = PTS_ULPI;
#endif
OUTREG32(&pRegs->OTG.PORTSC, *temp);
// usb_ulpi_interrupt_enable
temp = (DWORD *)&Ctrl;
*temp = INREG32(&pRegs->USB_CTRL);
#if (USB_HOST_MODE == 0)
Ctrl.OUIE = OUIE_INT_WAKE_IGNORE;
#else
Ctrl.OUIE = OUIE_INT_WAKE_ENABLE;
#endif
OUTREG32(&pRegs->USB_CTRL, *temp);
// Serial Interface config
#if (USB_HOST_MODE == 0)
temp = (DWORD *)&Ctrl;
*temp = INREG32(&pRegs->USB_CTRL);
Ctrl.OSIC = 0x1; //OWIE_INT_ENABLE;
OUTREG32(&pRegs->USB_CTRL, *temp);
#endif
// usb_otg_interrupt_enable
temp = (DWORD *)&Ctrl;
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -