TMS320F28379D: USB failed to be recognized

#pragma CODE_SECTION(BootLoadStart,"ramfuncs");

Uint16 BootLoadCsmUnlock()
{
	Uint16 ui16I;
	Uint16 ui16Sum;
	Uint16 ui16TxBuffer[5];
	
	Uint16 ui16Key[8] = {0xFFFF};
    Uint16 ulFlagUnlock;

    for(ui16I = 0; ui16I <= 11; ui16I++)
    {
    	u16UsbRxBuffer[ui16I] = (*GetWordData)();
    }

	ui16Sum = 0;
    for(ui16I=1; ui16I<=10; ui16I++)
    {
    	ui16Sum += (u16UsbRxBuffer[ui16I]>>8)&0xFF;
    	ui16Sum += (u16UsbRxBuffer[ui16I]>>0)&0xFF;
    }

	if ((u16UsbRxBuffer[0] != 0xA5AA) || (u16UsbRxBuffer[1] != 0x5700)
		|| ((u16UsbRxBuffer[2]>>8)>4) || (0xA1 != (u16UsbRxBuffer[2]&0xFF))
		||  (0x5A != (u16UsbRxBuffer[11]&0xFF))
		|| ((ui16Sum&0xFF) != ((u16UsbRxBuffer[11]>>8)&0xFF)))
	{
		ui16TxBuffer[0] = 0xA5;
		ui16TxBuffer[1] = 0x00;
		
		ui16TxBuffer[2] = 0xA2;
		ui16TxBuffer[3] = 0x5A;
		
		ui16TxBuffer[4] = 0xA2;

		TxDataEp1(ui16TxBuffer, 5, USB_END_DATA);
		return 0;
	}

	if ((u16UsbRxBuffer[2]>>8)&0x1) // zone(bit9):method(bit8)
	{
	   ui16Key[0] = 0x3139;
	   ui16Key[1] = 0x3032;
	   ui16Key[2] = 0x3038;
	   ui16Key[3] = 0x3230;
	   ui16Key[4] = 0x3033;
	   ui16Key[5] = 0x3037;
	   ui16Key[6] = 0x3037;
	   ui16Key[7] = 0x3230;
	}
	else // Record Csm Passwords
	{
	   ui16Key[0] = u16UsbRxBuffer[3];
	   ui16Key[1] = u16UsbRxBuffer[4];
	   ui16Key[2] = u16UsbRxBuffer[5];
	   ui16Key[3] = u16UsbRxBuffer[6];
	   ui16Key[4] = u16UsbRxBuffer[7];
	   ui16Key[5] = u16UsbRxBuffer[8];
	   ui16Key[6] = u16UsbRxBuffer[9];
	   ui16Key[7] = u16UsbRxBuffer[10];
	}
	ulFlagUnlock = ((u16UsbRxBuffer[2]>>9)&0x1) ?
					CsmUnlockZone2(ui16Key):CsmUnlockZone1(ui16Key);
/*	
	if ((u16UsbRxBuffer[2]>>9)&0x1) // zone(bit9)
		ulFlagUnlock = CsmUnlockZone2(&ui16Key);
	else
		ulFlagUnlock = CsmUnlockZone1(&ui16Key);*/
	
	if (1 == ulFlagUnlock)
	{
		ui16TxBuffer[0] = 0xA5;
		ui16TxBuffer[1] = 0x00;
		ui16TxBuffer[2] = 0xA1;
		ui16TxBuffer[3] = 0x5A;
		ui16TxBuffer[4] = 0xA1;

		TxDataEp1(ui16TxBuffer, 5, USB_END_DATA);
		return 1;
	}
	else
	{
		ui16TxBuffer[0] = 0xA5;
		ui16TxBuffer[1] = 0x00;
		ui16TxBuffer[2] = 0xA2;
		ui16TxBuffer[3] = 0x5A;
		ui16TxBuffer[4] = 0xA2;

		TxDataEp1(ui16TxBuffer, 5, USB_END_DATA);
		return 0;
	}
	
}

#define STATUS_FAIL          0
#define STATUS_SUCCESS       1

Uint16 CsmUnlockZone1(Uint16 ui16CsmKey[])
{
    volatile Uint16 temp;
	//CSM register file
	volatile long int *CSM = (volatile long int *)0x5F000; 
	//CSM Password location (assumingdefault Zone sel block)
	volatile long int *CSMPWL = (volatile long int *)0x78028;
	// If the password locations (CSMPWL) are all = ones (0xFFFF),
	// then the zone will now be unsecure. If the password
	// is not all ones (0xFFFF), then the code below is required
	// to unsecure the CSM.
	// Write the 128-bit password to the CSMKEY registers
	// If this password matches that stored in the
	// CSLPWL then the CSM will become unsecure. If it does not
	// match, then the zone will remain secure.
	// An example password of:
	// 0x11112222333344445555666677778888 is used.
	// *CSM++ = 0x22221111; // Register Z1_CSMKEY0 at 0x5F010
	// *CSM++ = 0x44443333; // Register Z1_CSMKEY1 at 0x5F012
	// *CSM++ = 0x66665555; // Register Z1_CSMKEY2 at 0x5F014
	// *CSM++ = 0x88887777; // Register Z1_CSMKEY3 at 0x5F016
	
    // Load the key registers with the current password. The 0xFFFF's are dummy
    // passwords.  User should replace them with the correct password for the DSP.

	// If the password locations (CSMPWL) are all = ones,the zone is unsecured.
	if (!(DcsmZ1Regs.Z1_CR.bit.ALLONE)) // Unlock when zone is secured.
	{
		EALLOW;
		DcsmZ1Regs.Z1_CSMKEY0 = ui16CsmKey[0]+ui16CsmKey[1]<<16;
		DcsmZ1Regs.Z1_CSMKEY1 = ui16CsmKey[2]+ui16CsmKey[3]<<16;
		DcsmZ1Regs.Z1_CSMKEY2 = ui16CsmKey[4]+ui16CsmKey[5]<<16;
		DcsmZ1Regs.Z1_CSMKEY3 = ui16CsmKey[6]+ui16CsmKey[7]<<16;
		EDIS;	
	}
	else
		return STATUS_SUCCESS;
	
	// If the CSM unlocked, return success, otherwise return
	// failure.
	if (DcsmZ1Regs.Z1_CR.bit.UNSECURE) return STATUS_SUCCESS;
	else return STATUS_FAIL;
		
}

Uint16 CsmUnlockZone2(Uint16 ui16CsmKey[])
{
    volatile Uint16 temp;
	// CSM register file
	// volatile long int *CSM = (volatile long int *)0x5F000; 
	// CSM Password location (assumingdefault Zone sel block)
	// volatile long int *CSMPWL = (volatile long int *)0x78028;
	
	// If the password locations (CSMPWL) are all = ones (0xFFFF),
	// then the zone will now be unsecure. If the password
	// is not all ones (0xFFFF), then the code below is required
	// to unsecure the CSM.
	// Write the 128-bit password to the CSMKEY registers
	// If this password matches that stored in the
	// CSLPWL then the CSM will become unsecure. If it does not
	// match, then the zone will remain secure.
	// An example password of:
	// 0x11112222333344445555666677778888 is used.
	// *CSM++ = 0x22221111; // Register Z1_CSMKEY0 at 0x5F010
	// *CSM++ = 0x44443333; // Register Z1_CSMKEY1 at 0x5F012
	// *CSM++ = 0x66665555; // Register Z1_CSMKEY2 at 0x5F014
	// *CSM++ = 0x88887777; // Register Z1_CSMKEY3 at 0x5F016
	
    // Load the key registers with the current password. The 0xFFFF's are dummy
    // passwords.  User should replace them with the correct password for the DSP.

	// If the password locations (CSMPWL) are all = ones,the zone is unsecured.
	if (!(DcsmZ2Regs.Z2_CR.bit.ALLONE)) // Unlock when zone is secured.
	{
		EALLOW;
		DcsmZ2Regs.Z2_CSMKEY0 = ui16CsmKey[0]+ui16CsmKey[1]<<16;
		DcsmZ2Regs.Z2_CSMKEY1 = ui16CsmKey[2]+ui16CsmKey[3]<<16;
		DcsmZ2Regs.Z2_CSMKEY2 = ui16CsmKey[4]+ui16CsmKey[5]<<16;
		DcsmZ2Regs.Z2_CSMKEY3 = ui16CsmKey[6]+ui16CsmKey[7]<<16;
		EDIS;	
	}
	else
		return STATUS_SUCCESS;
	
	// If the CSM unlocked, return success, otherwise return
	// failure.
	if (DcsmZ2Regs.Z2_CR.bit.UNSECURE) return STATUS_SUCCESS;
	else return STATUS_FAIL;
		
}



USB_Init()������

//#################################################
// void USB_Init(void)
//-----------------------------------------------
// Jump starts some vital set-up for USB protocol.
//-----------------------------------------------
void USB_Init(){
	//enable USB controller clock
	//initialize three layers of interrupt enables
	//peripheral interrupt, PIE interrupt, EINT/DINT
	EALLOW;
#if 0
	//ClkCfgRegs.CLKSRCCTL1.bit.OSCCLKSRCSEL = 0x0;       //Use INTOSC2 (~10 MHz) as the main PLL clock source
    ClkCfgRegs.SYSPLLMULT.all = 12;                     //Set IMULT to 12, clear FMULT
	ClkCfgRegs.SYSPLLCTL1.bit.PLLEN = 1;                //Enable the main PLL
	ClkCfgRegs.SYSCLKDIVSEL.bit.PLLSYSCLKDIV = 0;       //Set PLLSYSCLKDIV to 1
    while (ClkCfgRegs.SYSPLLSTS.bit.LOCKS != 1) {;}     //Wait for the PLL to lock
    ClkCfgRegs.SYSPLLCTL1.bit.PLLCLKEN = 1;             //Turn off the main PLL bypass


    //ClkCfgRegs.CLKSRCCTL2.bit.AUXOSCCLKSRCSEL = 0x1;    //Use XTAL (20 MHz) as the aux PLL clock source
    ClkCfgRegs.AUXPLLMULT.all = 6;                      //Set IMULT to 6, clear FMULT - 120MHz
    ClkCfgRegs.AUXPLLCTL1.bit.PLLEN = 1;                //Enable the aux PLL
    ClkCfgRegs.AUXCLKDIVSEL.bit.AUXPLLDIV = 2/2;        //Set AUXPLLDIV to 2
    while (ClkCfgRegs.AUXPLLSTS.bit.LOCKS != 1) {;}     //Wait for the PLL to lock
    ClkCfgRegs.AUXPLLCTL1.bit.PLLCLKEN = 1;             //Turn off aux PLL bypass
#endif
	DevCfgRegs.DC12.bit.USB_A = 1; //feature enabled: device only
	CpuSysRegs.PCLKCR11.bit.USB_A = 1; //module clock turned on

#if 0
	EntryAddr = TI_OTP_C1BROM_ESCAPE_POINT_13;
	if((EntryAddr != 0xffffffff) &&
			(EntryAddr != 0x00000000))
	{
		/*if OTP is programmed, then call OTP function*/
		((void (*)(void))EntryAddr)();
	}
#endif

    //Connect the PHY to the GPIO pins by setting the GPBAMSEL
    //bits for GPIOs 42 and 43. VBUS and ID are now de-spec'd
    //due to the lack of a 5V fail-safe ESD structure, so
    //GPIOs 46 and 47 are not muxed out.
    GpioCtrlRegs.GPBAMSEL.bit.GPIO42 = 1;
    GpioCtrlRegs.GPBAMSEL.bit.GPIO43 = 1;

	IER = 0x0000;
	IFR = 0x0000;
    //c1brom_enable_pie_in_boot(0);
    PieVectTable.USBA_INT = &UsbIntHandler;
	PieCtrlRegs.PIEIER9.bit.INTx15 = 1; //enable USBA interrupt(CPU1 only)
	EDIS;
	IER |= M_INT9;
	EINT;

#if 0
    EntryAddr = TI_OTP_C1BROM_ESCAPE_POINT_13;
    if((EntryAddr != 0xFFFFFFFF) &&
            (EntryAddr != 0x00000000))
    {
        /*if OTP is programmed, then call OTP function*/
        ((void (*)(void))EntryAddr)();
    }
#endif

    //Reset the USB driver's global variables
    ResetUsbDriver();

    //Force USB device mode by setting DEVMODOTG and DEVMOD
	USBREG32(USB_O_GPCS) = 0x3;

	//Clear active interrupts
	USBREG16(USB_O_TXIS);
	USBREG16(USB_O_RXIS);
	USBREG8(USB_O_IS);

	//Set up endpoint 1 for bulk transfers with a 64-byte FIFO
	USBREG8(USB_O_EPIDX) = 1;
	USBREG8(USB_O_RXFIFOSZ) = 0x03;
	USBREG16(USB_O_RXFIFOADD) = 0x100;
	USBREG8(USB_O_RXCSRH1) = 0x40;
	
	//Set up endpoint 1 for bulk transfers with a 64-byte FIFO
	USBREG8(USB_O_TXFIFOSZ) = 0x03;
	USBREG16(USB_O_TXFIFOADD) = 0x120;
	USBREG8(USB_O_TXCSRH1) = 0x20;

	//Enable USB interrupts for EP0 transmit/receive, EP1 receive, disconnection, and reset
	//USBREG16(USB_O_TXIE) = 0x0001;
	USBREG16(USB_O_TXIE) = 0x0003;
	USBREG16(USB_O_RXIE) = 0x0002;
	USBREG8(USB_O_IE) = (USB_IE_DISCON | USB_IE_RESET);

	//Attach the USB PHY to the bus
	USBREG8(USB_O_POWER) |= USB_POWER_SOFTCONN;
}