📄 gfd_usb_hl.c
字号:
desc_len = (des_tmp > 0x20)? 0x20 : des_tmp;
if(des_tmp > 0x20)
statempty = EMPTY;
break;
case PDC_STRING_DESC_TYPE:
switch(command[2])
{
case 0:
head_temp = (unsigned char *)unicode_string;
root = unicode_string;
desc_len = sizeof(unicode_string);
break;
case 1:
head_temp = (unsigned char *)mfg_string;
root = mfg_string;
desc_len = sizeof(mfg_string);
break;
case 2:
head_temp = (unsigned char *)product_string;
root = product_string;
desc_len = sizeof(product_string);
break;
case 3:
head_temp = (unsigned char *)serial_string;
root = serial_string;
desc_len = sizeof(serial_string);
break;
default:
break;
}
break;
default:
break;
}
//urb
if(head_temp)
{
/* Get max length that remote end wants */
req_len =command[6]|(command[7]<<8);
if (desc_len > req_len )
{
desc_len = req_len ;
}
}
}
void pdc_bus_SET_CONFIGURATION(void)
{
return;
}
U32 transcl(unsigned char *head)
{
unsigned char *urb;
int j, ti;
U32 t;
ti = desc_len;
urb = head;
if(ti < 8)
{
*(RP)(USB_TXLENGTH) = ti;//the pocket, less than 8 bytes
}
else
{
*(RP)(USB_TXLENGTH) = 8;
}
j=ti/8;
usbmod = ti%8;
if(usbstate == USBCG)
{
if(desc_len <= 8)
{
//USB_DMA_TRANS_TX((U32)urb,(U32)USB_TXFIFO,0x32,0x32,0x16,0x0,0x10);
USB_DMA_TRANS_TX((U32)urb,(U32)USB_TXFIFO,0x32,0x32,0x16,CHAN,0x10);
}
else
{
longpk = LONGPKSTATE;
longurb = head + j*64;
if(usbmod ||(statempty == EMPTY))
{
usbdmapp = APP;
}
else if (!usbmod)
{
longpk = SHORTPK;
}
//USB_DMA_TRANS_TX((U32)urb,(U32)USB_TXFIFO,0x32,0x32,0x16,0x0,j*0x10);
USB_DMA_TRANS_TX((U32)urb,(U32)USB_TXFIFO,0x32,0x32,0x16,CHAN,j*0x10);
}
}
else
{
/*the first pocket*/
usbstate = USBCG;//modified
//USB_DMA_TRANS_TX((U32)urb,(U32)USB_TXFIFO,0x32,0x32,0x16,0x0,0x10);
USB_DMA_TRANS_TX((U32)urb,(U32)USB_TXFIFO,0x32,0x32,0x16,CHAN,0x10);
}
}
ER HA_GFDUSB_INTHANDLE(void) //;when there is usb interrupt,the process starts
{
ER Epstat;
U32 evnt,intr,imask;
int i;
intr = usb_lock_readreg(USB_INTR);
imask = usb_read_reg(USB_INTRMASK);
Epstat = usb_lock_readreg(USB_EPINFO);
if(((Epstat &= 0x1f)== 0) || ((Epstat &= 0x1f)== 1))
{
epstate = EPCL;
while(1)
{
/* Read IRQ status*/
evnt = intr & (SETUP|IN|OUT|PING|TRAERR|ACK|STCOV|CTRAERR|RESET) & (~imask);
/* No irq? */
if (evnt==0)
{
return 0;
}
if(evnt & RESET)
{
usbtime++;
//for(i;i<21;i++);
head_temp = NULL;
desc_len = 1;
state1 = 1;
urb_num = 0;
stat_des = 0;
stat_add = 0;
stat_conf = 0;
stat_defa = 0;
stat_out1 = 0;
stat_defa1 =0;
stat_ack = 0;
stat_in = 0;
statep1 = 0;
state_in = 0;
state3 = 0;
stateep1 = 0;
descactu_len = 0;
requlen = 0;
//usbstate = USBDEF;
bulkstat = BULKOUTSTAT;
transstat = TRANSBG;
bulkinepstat = BULKINDO;
longpk = SHORTPK;
statempty = NEMPTY;
setconstate = NSETCONFIG;
blkstate = BLKCMD;
usbmod = 0;
unsinglepocket = UNSINGLE;
sing = UNSI;
timen = 0;
timres=0;
longblk = SHORTBLK;
usbdmapp = NAPP;
blt=0;
lstate=0;
usb_write_reg((U32)USB_EP0OUTSTAT, 0x02);
usb_write_reg((U32)USB_EP1OUTSTAT, 0x02);
usb_write_reg((U32)USB_EP2INSTAT, 0x02);
usb_write_reg((U32)USB_INTR, 0x0);
usb_write_reg((U32)USB_INTRMASK, 0x172);
usb_RMW_clrreg(USB_INTR,0x7ffffdff);
}
if(evnt & out)
{
OUTINTR();
usb_RMW_clrreg(USB_INTR,0x7ffffffb);
evnt = usb_lock_readreg(USB_INTR);
}
if( evnt & setup)
{
usb_irq_setup();
usb_RMW_clrreg(USB_INTR,0x7ffffffe);
evnt = usb_lock_readreg(USB_INTR);
}
if(evnt & ping)
{
usb_RMW_clrreg(USB_INTR,0x7ffffff7);
evnt = usb_lock_readreg(USB_INTR);
while(1);
}
if(evnt & traerr)
{
usb_RMW_clrreg(USB_INTR,0x7fffffef);
evnt = usb_lock_readreg(USB_INTR);
while(1);
}
if (evnt & stcov)
{
usb_write_reg(USB_PKTPASSEDCTRL,0x00);
usb_write_reg(USB_PKTDROPPEDCTRL,0x00);
usb_write_reg(USB_CRCERRCTRL,0x00);
usb_write_reg(USB_BITSTUFFERRCTRL,0x00);
usb_write_reg(USB_PIDERRCTRL,0x00);
usb_write_reg(USB_FRAMINGERrCTRL,0x00);
usb_write_reg(USB_TXPKTCTRL,0x00);
usb_RMW_clrreg(USB_INTR,0x7fffffbf);
evnt = usb_lock_readreg(USB_INTR);
}
if(evnt & ctraerr)
{
usb_RMW_clrreg(USB_INTR,0x7fffff7f);;
evnt = usb_lock_readreg(USB_INTR);
}
intr = usb_lock_readreg(USB_INTR);
imask = usb_read_reg(USB_INTRMASK);
}
}
else
{
epstate = EPBULK;
evnt = intr & (SETUP|IN|OUT|PING|TRAERR|ACK|STCOV|CTRAERR|RESET) & (~imask);
if(evnt & OUT)
{
OUTINTR();
usb_RMW_clrreg(USB_INTR,0x7ffffffb);
}
}
if(evnt & RESET)
{
usb_RMW_clrreg(USB_INTR,0x7ffffdff);
//while(1);
}
if (evnt & stcov)
{
usb_write_reg(USB_PKTPASSEDCTRL,0x00);
usb_write_reg(USB_PKTDROPPEDCTRL,0x00);
usb_write_reg(USB_CRCERRCTRL,0x00);
usb_write_reg(USB_BITSTUFFERRCTRL,0x00);
usb_write_reg(USB_PIDERRCTRL,0x00);
usb_write_reg(USB_FRAMINGERrCTRL,0x00);
usb_write_reg(USB_TXPKTCTRL,0x00);
usb_RMW_clrreg(USB_INTR,0x7fffffbf);
evnt = usb_lock_readreg(USB_INTR);
while(1);
}
if(evnt & traerr)
{
usb_RMW_clrreg(USB_INTR,0x7fffffef);
evnt = usb_lock_readreg(USB_INTR);
while(1);
}
}
/*OUT POCKET HANDLE*/
ER OUTINTR(void)
{
U32 t,t1,t2;
int ti,j;
ER stat;
volatile U32 i;
stat_out1++ ;
stat = usb_lock_readreg(USB_EPINFO);
if((stat &= 0x1f) != 0x0)
{
/* NON0EDNP HANDLE*/
state_in = 0;
statep1 = 1;//endp1 transport
/*BLK CMD STATE*/
if(blkstate == BLKCMD)
{
usb_write_reg((U32)USB_INTRMASK, 0x176);
t2 = *(RP)(USB_RECEIVETYPE) & 0x4;
//outtime = 0;
while((t2 == 0x0) )// && (outtime < 1000))
{
t2 = *(RP)(USB_RECEIVETYPE) & 0X4;
outtime++;
}
//if(outtime < 1000)
{
if(t2 == 0x4)
{
R = RX;
/*CBW STATE*/
usbdmapp = APP;
//USB_DMA_TRANS_RX((U32)USB_RXFIFO,(U32)R,0x32,0x32,0x16,0x0,0x10);
USB_DMA_TRANS_RX((U32)USB_RXFIFO,(U32)R,0x32,0x32,0x16,CHAN,0x10);
i = *(volatile U32 *)DMACCConfiguration;
while((i & 0x1) != 0)
{
i = *(volatile U32 *)DMACCConfiguration;
}
R = R + 64;
t = usb_read_reg(USB_RXLENGTH);
if(t != 64)
{
t = 64 - t;
R = R - t;
}
}
}
}
}
else
{
statep1 = 0;
*(RP)USB_RECEIVETYPE &= 0x07;
}
return(0);
}
void ENT_INT_USB(void)
{
ent_int();
mask_irq(INT_USB);
HA_GFDUSB_INTHANDLE();
unmask_irq(INT_USB);
ret_int();
}
void usbswap_data(U32 *src, U16 len)
{
char *psrc, *pdst, tmp;
int i;
psrc = (char *)src;
for(i = 0; i < len*128; i++)
{
tmp = *(psrc+3);
*(psrc+3) = *psrc;
*psrc = tmp;
tmp = *(psrc+2);
*(psrc+2) = *(psrc+1);
*(psrc+1) = tmp;
src++;
psrc = (char *)src;
}
}
INT usbpc_rd_io(UINT16 driveno, UINT32 block, VOID *buffer, UINT32 count,
INT reading)
{
#ifdef WORDWRITE
UINT32 *p;
UINT32 ltemp;
UINT16 page_number;
UINT32 byte_number;
INT16 i;
UINT32 *pbuffer;
#else
UINT8 *p;
UINT32 ltemp;
UINT16 page_number;
UINT16 byte_number;
INT16 i;
UINT8 *pbuffer;
#endif
#ifdef WORDWRITE
/* We don't use drive no. You could have multiple drives if wanted */
driveno = driveno;
pbuffer = (UINT32 *)buffer;
while (count)
{
/* Get the page number */
ltemp = block / RAMDISK_PAGE_SIZE;
page_number = (UINT16) ltemp;
/* Check. This shouldn't happen */
if ( (page_number >= NUM_RAMDISK_PAGES) || !rd_pages[page_number] )
return(NO);
/* Get the offset */
ltemp = block % RAMDISK_PAGE_SIZE;
byte_number = (UINT32) (ltemp*128);
p = (UINT32 *)rd_pages[page_number];
p += byte_number;
if (reading&0x01) // &0x01 for flash flush.
{
for (i = 0; i < 128; i++)
*pbuffer++ = *p++;
}
else
{
for (i = 0; i < 128; i++)
*p++ = *pbuffer++;
}
count--;
block++;
}
#else
/* We don't use drive no. You could have multiple drives if wanted */
driveno = driveno;
pbuffer = (UINT8 *)buffer;
while (count)
{
/* Get the page number */
ltemp = block / RAMDISK_PAGE_SIZE;
page_number = (UINT16) ltemp;
/* Check. This shouldn't happen */
if ( (page_number >= NUM_RAMDISK_PAGES) || !rd_pages[page_number] )
return(NO);
/* Get the offset */
ltemp = block % RAMDISK_PAGE_SIZE;
byte_number = (UINT16) (ltemp*512);
p = rd_pages[page_number];
p += byte_number;
if (reading&0x01) // &0x01 for flash flush.
{
for (i = 0; i < 512; i++)
*pbuffer++ = *p++;
}
else
{
for (i = 0; i < 512; i++)
*p++ = *pbuffer++;
}
count--;
block++;
}
#endif
return(YES);
}
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -