www.pudn.com > USB_Device.rar > usb.c
#include "def.h"
#include "board.h"
#include "2410addr.h"
#include "2410usb.h"
#include "usblib.h"
#include "usbsetup.h"
#include "usbout.h"
#include "usbin.h"
#ifdef USB_DOWNLOAD_SUPPORT
//======================================================
extern volatile U32 download_addr;
extern volatile U32 download_len;
volatile U8 *downPt;
volatile U32 totalDmaCount;
volatile U16 checkSum;
volatile int isUsbdSetConfiguration;
//======================================================
static void __irq IsrUsbd(void)
{
U8 usbdIntpnd, epIntpnd;
U8 saveIndexReg = rINDEX_REG;
usbdIntpnd = rUSB_INT_REG;
epIntpnd = rEP_INT_REG;
if(usbdIntpnd&SUSPEND_INT)
{
rUSB_INT_REG = SUSPEND_INT;
}
if(usbdIntpnd&RESUME_INT)
{
rUSB_INT_REG = RESUME_INT;
}
if(usbdIntpnd&RESET_INT)
{
//ResetUsbd();
ReconfigUsbd();
rUSB_INT_REG = RESET_INT; //RESET_INT should be cleared after ResetUsbd().
//PrepareEp1Fifo();
}
if(epIntpnd&EP0_INT)
{
rEP_INT_REG = EP0_INT;
Ep0Handler();
}
if(epIntpnd&EP1_INT)
{
rEP_INT_REG=EP1_INT;
Ep1Handler();
}
if(epIntpnd&EP2_INT)
{
rEP_INT_REG = EP2_INT;
//Ep2Handler();
}
if(epIntpnd&EP3_INT)
{
rEP_INT_REG = EP3_INT;
Ep3Handler();
}
if(epIntpnd&EP4_INT)
{
rEP_INT_REG = EP4_INT;
//Ep4Handler();
}
ClearPending(BIT_USBD);
rINDEX_REG = saveIndexReg;
}
U32 UsbState;
U32 UsbInLength;
U8 *UsbTxAddr;
void UsbdInit(U8 fun)
{
isUsbdSetConfiguration = 0;
// ChangeUPllValue(40, 4, 1); //UCLK=48Mhz
rUPLLCON = (40<<12) | (4<<4) | 1;
InitDescriptorTable(fun);
ReconfigUsbd();
// PrepareEp1Fifo();
UsbState = 0;
}
//======================================================
static __inline void cpu_arm920_cache_clean_invalidate_all(void)
{
__asm{
mov r1, #0
mov r1, #7 << 5 /* 8 segments */
cache_clean_loop1:
orr r3, r1, #63UL << 26 /* 64 entries */
cache_clean_loop2:
mcr p15, 0, r3, c7, c14, 2 /* clean & invalidate D index */
subs r3, r3, #1 << 26
bcs cache_clean_loop2 /* entries 64 to 0 */
subs r1, r1, #1 << 5
bcs cache_clean_loop1 /* segments 7 to 0 */
mcr p15, 0, r1, c7, c5, 0 /* invalidate I cache */
mcr p15, 0, r1, c7, c10, 4 /* drain WB */
}
}
void cache_clean_invalidate(void)
{
cpu_arm920_cache_clean_invalidate_all();
}
static __inline void cpu_arm920_tlb_invalidate_all(void)
{
__asm{
mov r0, #0
mcr p15, 0, r0, c7, c10, 4 /* drain WB */
mcr p15, 0, r0, c8, c7, 0 /* invalidate I & D TLBs */
}
}
void tlb_invalidate(void)
{
cpu_arm920_tlb_invalidate_all();
}
void call_linux(U32 a0, U32 a1, U32 a2)
{
void (*goto_start)(U32, U32);
cache_clean_invalidate();
tlb_invalidate();
__asm{
// mov r0, a0//%0
// mov r1, a1//%1
// mov r2, a2//%2
mov ip, #0
mcr p15, 0, ip, c13, c0, 0 /* zero PID */
mcr p15, 0, ip, c7, c7, 0 /* invalidate I,D caches */
mcr p15, 0, ip, c7, c10, 4 /* drain write buffer */
mcr p15, 0, ip, c8, c7, 0 /* invalidate I,D TLBs */
mrc p15, 0, ip, c1, c0, 0 /* get control register */
bic ip, ip, #0x0001 /* disable MMU */
mcr p15, 0, ip, c1, c0, 0 /* write control register */
//mov pc, r2
//nop
//nop
/* no outpus */
//: "r" (a0), "r" (a1), "r" (a2)
}
// SetClockDivider(1, 1);
// SetSysFclk(FCLK_200M); //start kernel, use 200M
Delay(100);
goto_start = (void (*)(U32, U32))a2;
(*goto_start)(a0, a1);
}
static int WaitDownload(U32 addr);
static int BoardUsbDownload(U32 addr, U32 run)
{
U8 fun;
int len;
rGPHCON = rGPHCON&~(0xf<<18)|(0x5<<18);
//To enhance the USB signal quality.
//CLKOUT 0,1=OUTPUT to reduce the power consumption.
rGPGCON &= 0xfff3ffff; //GPG9 input
fun = 1;
UsbdInit(fun);
Delay(100);
rGPGCON |= 0x00040000;
rGPGDAT |= 0x0200; //GPG9 ouput 1
pISR_USBD =(unsigned)IsrUsbd;
ClearPending(BIT_USBD);
EnableIrq(BIT_USBD);
len = WaitDownload(addr);
DisableIrq(BIT_USBD);
rGPGCON &= 0xfff3ffff; //GPG9 input
if(len>0) {
printf("\nPress any key to continue...\n");
getch();
if(run) {//getyorn()) {
//void (*fun)(void) = (void (*)(void))download_addr;
//CacheDisable();
//CacheFlush();
rINTMSK = BIT_ALLMSK;
Delay(100);
//(*fun)();
call_linux(0, 193, download_addr);
}
}
return len;
}
int LoadFileFromUsb(U32 a1, U32 a2, U32 a3, U32 a4)
{
puts("USB download file\n");
return BoardUsbDownload(0, 0);
}
/*************************************************************/
U32 UsbPoll(void);
static int WaitDownload(U32 addr)
{
U32 UsbConnected = 0;
U32 i, j;
U32 temp;
U8 tempMem[16];
U16 cs, dnCS;
#if 0
MMU_DisableICache();
//For multi-ICE.
//If ICache is not turned-off, debugging is started with ICache-on.
#endif
/*******************************/
/* Test program download */
/*******************************/
checkSum = 0;
downPt = tempMem; //This address is used for receiving first 8 byte.
download_addr = addr; //_RAM_STARTADDRESS;
download_len = 0;
puts("Press Esc key to exit\n");
while(!isUsbdSetConfiguration)
{
if(getkey()==ESC_KEY)
return -1;
}
puts("USB connected\n");
/* DisableIrq(BIT_USBD);
DisableIrq(BIT_DMA2);
while(!UsbPoll())
{
if(getkey()==ESC_KEY)
{
puts("USB download aborted.\n");
return -1;
}
}
DbgOut("End, Received %dBytes\n",(U32)downPt-download_addr);
checkSum=checkSum - *((unsigned char *)(download_addr+download_len-8-2))
- *( (unsigned char *)(download_addr+download_len-8-1) );
goto PollRxEnd;
*/
j=0;
while(download_len==0)
{
if(j%0x50000==0)
LedSet(0xf);
if(j%0x50000==0x28000)
LedSet(0x0);
j++;
if(getkey()==ESC_KEY)
{
puts("USB download aborted.\n");
return -1;
}
if(isUsbdSetConfiguration)
{
if(!UsbConnected)
puts("Now, USB is connected.");
UsbConnected = 1;
}
}
#if USBDMA
ClearEp3OutPktReady(); //中断处理读完第一个包后未清OutPktReady位,在此清掉
if(download_len>EP3_PKT_SIZE)
{
if(download_len<=(0x80000))
ConfigEp3DmaMode(download_addr+EP3_PKT_SIZE-8,download_len-EP3_PKT_SIZE);
else
ConfigEp3DmaMode(download_addr+EP3_PKT_SIZE-8,0x80000-EP3_PKT_SIZE);
totalDmaCount=0;
}
else // download_len < EP3_PKT_SIZE
totalDmaCount=download_len;
#endif
printf("\nNow, Downloading [ADDRESS:%xh,TOTAL:%d]\n",
download_addr, download_len);
j=0x80000;
#if USBDMA
while(totalDmaCount=j)
{
/* static int led = 0x0;
led ^=2;
Led_Display(led);*/
putch('d');
j+=0x80000;
}
if(getkey()==ESC_KEY)
{
int i;
ConfigEp3IntMode();
DisableIrq(BIT_DMA2);
DbgOut("\nReceive process aborted.\n");
DbgOut("Received %d bytes\n", totalDmaCount);
for(i=0; i<32;i++)
{
printf("0x%x = %x\n", download_addr+i*0x100000, *(U32 *)(download_addr+i*0x100000));
}
return -1;
}
}
#else
while(((U32)downPt-download_addr)<(download_len-8))
{
if(((U32)downPt-download_addr)>=j)
{
static int led = 0x0;
led ^= 2;
Led_Display(led);
putch('i');
j+=0x80000;
}
if(getkey()==ESC_KEY)
{
int i;
DbgOut("\nReceive process aborted.\n");
DbgOut("Received %d bytes\n", (U32)downPt-download_addr);
for(i=0;i<48;i++)
{
printf("0x%x = %x\n", download_addr+i*0x100000, *(U32 *)(download_addr+i*0x100000));
}
return -1;
}
}
#endif
#if USBDMA
/*******************************/
/* Verify check sum */
/*******************************/
printf("Now, Checksum calculation\n");
cs=0;
i=(download_addr);
j=(download_addr+download_len-10)&0xfffffffc;
while(i>8);
cs+=(U16)((temp&0xff0000)>>16);
cs+=(U16)((temp&0xff000000)>>24);
}
i=(download_addr+download_len-10)&0xfffffffc;
j=(download_addr+download_len-10);
while(i