?? sdi.c
字號:
printf("Rread timeout error");
return ;
}
status=rSDIFSTA;
if((status&0x1000)==0x1000)
{
//*Rx_buffer++=rSDIDAT;
//rd_cnt++;
Rx_buffer[rd_cnt++]=rSDIDAT;
}
}
//-- Check end of CMD11
if(!Chk_CMDend(11, 1))
goto RECMD11;
rSDICmdSTA=0xa00; // Clear cmd_end(with rsp)
//-- Check end of DATA
// rSDIDCON=(2<<22)|(1<<19)|(0<<17)|(0<<16)|(1<<14)|(0<<12);
rSDIDCON=(2<<22)|(1<<19)|(0<<17)|(0<<16); //YH 040220
rSDIDCON=rSDIDCON&~(7<<12); //YH 040220, no operation, data ready
while( rSDIDSTA&0x3 !=0x0 );
if(rSDIDSTA!=0)
printf("rSDIDSTA=0x%x\n", rSDIDSTA);
rSDIDSTA=0xff; //YH 040221
STRCMD12:
//--Stop cmd(CMD12)
rSDICmdARG=0x0; //CMD12(stuff bit)
rSDICmdCON=(0x1<<9)|(0x1<<8)|0x4c; //sht_resp, wait_resp, start, CMD12
//-- Check end of CMD12
if(!Chk_CMDend(12, 1))
goto STRCMD12;
rSDICmdSTA=0xa00; // Clear cmd_end(with rsp)
rSDIFSTA=rSDIFSTA&0x200; //Clear Rx FIFO Last data Ready, YH 040221
/*
//-- Display Rx data
//printf("\nRx data\n");
for(i=0;i<128*2;i++)
{
if(Rx_buffer[i] != Tx_buffer[i])
{
//printf("%08x, %08x\n",Tx_buffer[i], Rx_buffer[i]);
break;
}
}
*/
printf("rSDIFSTA1=0x%x\n", rSDIFSTA); //YH 040221
rSDIFSTA=rSDIFSTA&0x200; //Clear Rx FIFO Last data Ready, YH 040221
printf("rSDIFSTA2=0x%x\n", rSDIFSTA); //YH 040221
printf("\n--End stream read test\n");
}
void Wt_Block(void)
{
U32 mode;
int i,status;
wt_cnt=0;
printf("[Block write test]\n");
RE1:
printf("0:Polling write 1:Interrupt write 2:DMA write\nSelect the test mode?");
mode=(U32)GetIntNum();
if(mode>2)
goto RE1;
// rSDICON |= rSDICON|(1<<1); // FIFO reset
rSDIFSTA=rSDIFSTA|(1<<16); //YH 040223 FIFO reset
if(mode!=2)
// rSDIDCON=(2<<22)|(1<<20)|(1<<17)|(Wide<<16)|(3<<12)|(block<<0);
rSDIDCON=(2<<22)|(1<<20)|(1<<17)|(Wide<<16)|(1<<14)|(3<<12)|(block<<0); //YH 040220
//Word Tx, Tx after rsp, blk, 1bit bus, Tx start, blk num
rSDICmdARG=0x0; // CMD24/25(addr)
REWTCMD:
switch(mode)
{
case POL:
if(block<2) // SINGLE_WRITE
{
rSDICmdCON=(0x1<<9)|(0x1<<8)|0x58; //sht_resp, wait_resp, dat, start, CMD24
if(!Chk_CMDend(24, 1)) //-- Check end of CMD24
goto REWTCMD;
}
else // MULTI_WRITE
{
rSDICmdCON=(0x1<<9)|(0x1<<8)|0x59; //sht_resp, wait_resp, dat, start, CMD25
if(!Chk_CMDend(25, 1)) //-- Check end of CMD25
goto REWTCMD;
}
rSDICmdSTA=0xa00; // Clear cmd_end(with rsp)
while(wt_cnt<128*block)
{
status=rSDIFSTA;
if((status&0x2000)==0x2000)
{
rSDIDAT=*Tx_buffer++;
wt_cnt++;
//printf("Block No.=%d, wt_cnt=%d\n",block,wt_cnt);
}
}
break;
case INT:
pISR_SDI=(unsigned)Wt_Int;
rINTMSK = ~(BIT_SDI);
rINTSUBMSK =~(BIT_SUB_SDI);
printf ("INT MODE \n");
if(block<2) // SINGLE_WRITE
{
rSDICmdCON=(0x1<<9)|(0x1<<8)|0x58; //sht_resp, wait_resp, dat, start, CMD24
if(!Chk_CMDend(24, 1)) //-- Check end of CMD24
goto REWTCMD;
}
else // MULTI_WRITE
{
rSDICmdCON=(0x1<<9)|(0x1<<8)|0x59; //sht_resp, wait_resp, dat, start, CMD25
if(!Chk_CMDend(25, 1)) //-- Check end of CMD25
goto REWTCMD;
}
rSDICmdSTA=0xa00; // Clear cmd_end(with rsp)
rSDIINTMSK=0x8; // Tx FIFO half int.
while(!TR_end);
//while(wt_cnt<128);
rINTMSK |= (BIT_SDI);
rINTSUBMSK =~(BIT_SUB_SDI);
TR_end=0;
rSDIINTMSK=0;
// All mask
break;
case DMA:
pISR_DMA0=(unsigned)DMA_end;
rINTMSK = ~(BIT_DMA0);
rSDIDCON=rSDIDCON|(1<<24); //YH 040227, Burst4 Enable
rDISRC0=(int)(Tx_buffer); // Tx_buffer
rDISRCC0=(0<<1)+(0<<0); // AHB, inc
rDIDST0=(U32)(SDIDAT); // SDIDAT
rDIDSTC0=(1<<1)+(1<<0); // APB, fix
rDCON0=(1<<31)+(0<<30)+(1<<29)+(0<<28)+(0<<27)+(1<<22)+(2<<20)+128*block;
//handshake, sync PCLK, TC int, single tx, single service, SDI, H/W request,
//auto-reload off, word, 128blk*num
rDMASKTRIG0=(0<<2)+(1<<1)+0; //no-stop, DMA0 channel on, no-sw trigger
rDMAREQSEL0=(10<<1)+(1<<0);
// rSDIDCON=(2<<22)|(1<<20)|(1<<17)|(Wide<<16)|(1<<15)|(3<<12)|(block<<0);
rSDIDCON=(2<<22)|(1<<20)|(1<<17)|(Wide<<16)|(1<<15)|(1<<14)|(3<<12)|(block<<0); //YH 040220
// Word Tx, Tx after rsp, blk, 4bit bus, dma enable, Tx start, blk num
if(block<2) // SINGLE_WRITE
{
rSDICmdCON=(0x1<<9)|(0x1<<8)|0x58; //sht_resp, wait_resp, dat, start, CMD24
if(!Chk_CMDend(24, 1)) //-- Check end of CMD24
goto REWTCMD;
}
else // MULTI_WRITE
{
rSDICmdCON=(0x1<<9)|(0x1<<8)|0x59; //sht_resp, wait_resp, dat, start, CMD25
if(!Chk_CMDend(25, 1)) //-- Check end of CMD25
goto REWTCMD;
}
rSDICmdSTA=0xa00; // Clear cmd_end(with rsp)
while(!TR_end);
rINTMSK |= (BIT_DMA0);
TR_end=0;
rDMASKTRIG0=(1<<2); //DMA0 stop
break;
default:
break;
}
//-- Check end of DATA
if(!Chk_DATend())
printf("dat error\n");
rSDIDCON=rSDIDCON&~(7<<12); //YH 040220, Clear Data Transfer mode => no operation, Cleata Data Transfer start
rSDIDSTA=0x10; // Clear data Tx/Rx end
if(block>1)
{
//--Stop cmd(CMD12)
REWCMD12:
// rSDIDCON=(1<<18)|(1<<17)|(0<<16)|(1<<12)|(block<<0);
rSDIDCON=(1<<18)|(1<<17)|(0<<16)|(1<<14)|(1<<12)|(block<<0); //YH 040220
rSDICmdARG=0x0; //CMD12(stuff bit)
rSDICmdCON=(0x1<<9)|(0x1<<8)|0x4c; //sht_resp, wait_resp, start, CMD12
//-- Check end of CMD12
if(!Chk_CMDend(12, 1))
goto REWCMD12;
rSDICmdSTA=0xa00; // Clear cmd_end(with rsp)
//-- Check end of DATA(with busy state)
if(!Chk_BUSYend())
printf("error\n");
rSDIDSTA=0x08; //! Should be cleared by writing '1'.
}
}
void Wt_Stream(void) // only for MMC, 3blk write
{
int status, wt_cnt=0;
if(MMC!=1)
{
printf("Stream write command supports only MMC!\n");
return;
}
printf("\n[Stream write test]\n");
RECMD20:
// rSDIDCON=(2<<22)|(1<<20)|(0<<17)|(0<<16)|(3<<12); // stream mode
rSDIDCON=(2<<22)|(1<<20)|(0<<17)|(0<<16)|(1<<14)|(3<<12); // stream mode
rSDICmdARG=0x0; // CMD20(addr)
rSDICmdCON=(0x1<<9)|(0x1<<8)|0x54; //sht_resp, wait_resp, dat, start, CMD20
//-- Check end of CMD25
if(!Chk_CMDend(20, 1))
goto RECMD20;
rSDICmdSTA=0xa00; // Clear cmd_end(with rsp)
while(wt_cnt<128*block)
{
status=rSDIFSTA;
if((status&0x2000)==0x2000)
rSDIDAT=Tx_buffer[wt_cnt++];
}
//-- Check end of DATA
while( rSDIFSTA&0x400 );
Delay(10); // for the empty of DATA line(Hardware)
// rSDIDCON=(1<<20)|(0<<17)|(0<<16)|(1<<14)|(0<<12);
rSDIDCON=(1<<20)|(0<<17)|(0<<16); //YH 040220
rSDIDCON=rSDIDCON&~(7<<12); //YH 040220, no operation, data ready
while( (rSDIDSTA&0x3)!=0x0 );
if(rSDIDSTA!=0x0)
printf("rSDIDSTA=0x%x\n", rSDIDSTA);
rSDIDSTA=0xff; //Clear rSDIDSTA
STWCMD12:
//--Stop cmd(CMD12)
// rSDIDCON=(1<<18)|(1<<17)|(0<<16)|(1<<12);
rSDIDCON=(1<<18)|(1<<17)|(0<<16)|(1<<14)|(1<<12);
rSDICmdARG=0x0; //CMD12(stuff bit)
rSDICmdCON=(0x1<<9)|(0x1<<8)|0x4c; //sht_resp, wait_resp, start, CMD12
//-- Check end of CMD12
if(!Chk_CMDend(12, 1))
goto STWCMD12;
rSDICmdSTA=0xa00; // Clear cmd_end(with rsp)
//-- Check end of DATA(with busy state)
if(!Chk_BUSYend())
printf("error\n");
rSDIDSTA=0x08;
printf("\n--End Stream write test\n");
}
int Chk_CMDend(int cmd, int be_resp)
//0: Timeout
{
int finish0;
if(!be_resp) // No response
{
finish0=rSDICmdSTA;
while((finish0&0x800)!=0x800) // Check cmd end
finish0=rSDICmdSTA;
rSDICmdSTA=finish0;// Clear cmd end state
return 1;
}
else // With response
{
finish0=rSDICmdSTA;
while( !( ((finish0&0x200)==0x200) | ((finish0&0x400)==0x400) )) // Check cmd/rsp end
// while( !( ((finish0&0x200)==0x200) | ((finish0&0x400)==0x800) )) // Check cmd/rsp end
// while((finish0&0x1800)!=0x1800) //YH 0811 Check cmd end
// printf("CMD%d:rSDICmdSTA=0x%x\n", cmd, rSDICmdSTA); //YH 0811
finish0=rSDICmdSTA;
//YH 0624 if(cmd==1 | cmd==9 | cmd==41) // CRC no check
if(cmd==1 | cmd==41) // CRC no check, CMD9 is a long Resp. command.
{
if( (finish0&0xf00) != 0xa00 ) // Check error
{
rSDICmdSTA=finish0; // Clear error state
if(((finish0&0x400)==0x400))
return 0; // Timeout error
}
rSDICmdSTA=finish0; // Clear cmd & rsp end state
}
else // CRC check
{
if( (finish0&0x1f00) != 0xa00 ) // Check error
{
printf("CMD%d:rSDICmdSTA=0x%x, rSDIRSP0=0x%x\n",cmd, rSDICmdSTA, rSDIRSP0);
rSDICmdSTA=finish0; // Clear error state
if(((finish0&0x400)==0x400))
return 0; // Timeout error
}
rSDICmdSTA=finish0;
}
return 1;
}
}
int Chk_DATend(void)
{
int finish;
finish=rSDIDSTA;
while( !( ((finish&0x10)==0x10) || ((finish&0x20)==0x20) ))
// Chek timeout or data end
finish=rSDIDSTA;
if( (finish&0xfc) != 0x10 )
{
printf("DATA:finish=0x%x\n", finish);
rSDIDSTA=0xec; // Clear error state
return 0;
}
return 1;
}
int Chk_BUSYend(void)
{
int finish;
finish=rSDIDSTA;
while( !( ((finish&0x08)==0x08) | ((finish&0x20)==0x20) ))
finish=rSDIDSTA;
if( (finish&0xfc) != 0x08 )
{
printf("DATA:finish=0x%x\n", finish);
rSDIDSTA=0xf4; //clear error state
return 0;
}
return 1;
}
void CMD0(void)
{
//-- Make card idle state
rSDICmdARG=0x0; // CMD0(stuff bit)
rSDICmdCON=(1<<8)|0x40; // No_resp, start, CMD0
//-- Check end of CMD0
Chk_CMDend(0, 0);
rSDICmdSTA=0x800; // Clear cmd_end(no rsp)
}
int Chk_MMC_OCR(void)
{
int i;
//-- Negotiate operating condition for MMC, it makes card ready state
for(i=0;i<100;i++) //Negotiation time is dependent on CARD Vendors.
{
// rSDICmdARG=0xffc000; //CMD1(MMC OCR:2.6V~3.6V)
rSDICmdARG=0xff8000; //CMD1(SD OCR:2.7V~3.6V)
rSDICmdCON=(0x1<<9)|(0x1<<8)|0x41; //sht_resp, wait_resp, start, CMD1
//-- Check end of CMD1
// if(Chk_CMDend(1, 1) & rSDIRSP0==0x80ffc000) //[31]:Card Power up status bit (busy)
//0xffc000 is Voltage window
if(Chk_CMDend(1, 1) && (rSDIRSP0>>16)==0x80ff) //YH 0903 [31]:Card Power up status bit (busy)
// if(Chk_CMDend(1, 1) & rSDIRSP0==0x80ff8000)
{
rSDICmdSTA=0xa00; // Clear cmd_end(with rsp)
return 1; // Success
}
}
rSDICmdSTA=0xa00; // Clear cmd_end(with rsp)
return 0; // Fail
}
int Chk_SD_OCR(void)
{
int i,j=0;
//-- Negotiate operating condition for SD, it makes card ready state
for(i=0;i<50;i++) //If this time is short, init. can be fail.
{
CMD55(); // Make ACMD
rSDICmdARG=0xff8000; //ACMD41(SD OCR:2.7V~3.6V)
// rSDICmdARG=0xffc000; //ACMD41(MMC OCR:2.6V~3.6V)
rSDICmdCON=(0x1<<9)|(0x1<<8)|0x69;//sht_resp, wait_resp, start, ACMD41
//-- Check end of ACMD41
if( Chk_CMDend(41, 1) & rSDIRSP0==0x80ff8000 )
{
rSDICmdSTA=0xa00; // Clear cmd_end(with rsp)
return 1; // Success
}
Delay(200); // Wait Card power up status
}
//printf("SDIRSP0=0x%x\n",rSDIRSP0);
rSDICmdSTA=0xa00; // Clear cmd_end(with rsp)
return 0; // Fail
}
int CMD55(void)
{
//--Make ACMD
rSDICmdARG=RCA<<16; //CMD7(RCA,stuff bit)
rSDICmdCON=(0x1<<9)|(0x1<<8)|0x77; //sht_resp, wait_resp, start, CMD55
//-- Check end of CMD55
if(!Chk_CMDend(55, 1))
return 0;
rSDICmdSTA=0xa00; // Clear cmd_end(with rsp)
return 1;
}
int CMD13(void)//SEND_STATUS
{
int response0;
rSDICmdARG=RCA<<16; // CMD13(RCA,stuff bit)
rSDICmdCON=(0x1<<9)|(0x1<<8)|0x4d; // sht_resp, wait_resp, start, CMD13
//-- Check end of CMD13
if(!Chk_CMDend(13, 1))
return 0;
//printf("rSDIRSP0=0x%x\n", rSDIRSP0);
if(rSDIRSP0&0x100)
//printf("Ready for Data\n");
// else
//printf("Not Ready\n");
response0=rSDIRSP0;
response0 &= 0x3c00;
response0 = response0 >> 9;
//printf("Current Status=%d\n", response0);
if(response0==6)
Test_SDI();
rSDICmdSTA=0xa00; // Clear cmd_end(with rsp)
return 1;
}
int CMD9(void)//SEND_CSD
{
rSDICmdARG=RCA<<16; // CMD9(RCA,stuff bit)
rSDICmdCON=(0x1<<10)|(0x1<<9)|(0x1<<8)|0x49; // long_resp, wait_resp, start, CMD9
printf("\n****CSD register****\n");
//-- Check end of CMD9
if(!Chk_CMDend(9, 1))
return 0;
printf(" SDIRSP0=0x%x\n SDIRSP1=0x%x\n SDIRSP2=0x%x\n SDIRSP3=0x%x\n", rSDIRSP0,rSDIRSP1,rSDIRSP2,rSDIRSP3);
return 1;
}
void Set_1bit_bus(void)
{
Wide=0;
if(!MMC)
SetBus();
printf("\n****1bit bus****\n");
}
void Set_4bit_bus(void)
{
Wide=1;
SetBus();
printf("\n****4bit bus****\n");
}
void SetBus(void)
{
SET_BUS:
CMD55(); // Make ACMD
//-- CMD6 implement
rSDICmdARG=Wide<<1; //Wide 0: 1bit, 1: 4bit
rSDICmdCON=(0x1<<9)|(0x1<<8)|0x46; //sht_resp, wait_resp, start, CMD55
if(!Chk_CMDend(6, 1)) // ACMD6
goto SET_BUS;
rSDICmdSTA=0xa00; // Clear cmd_end(with rsp)
}
void Set_Prt(void)
{
//-- Set protection addr.0 ~ 262144(32*16*512)
printf("[Set protection(addr.0 ~ 262144) test]\n");
RECMD28:
//--Make ACMD
rSDICmdARG=0; // CMD28(addr)
rSDICmdCON=(0x1<<9)|(0x1<<8)|0x5c; //sht_resp, wait_resp, start, CMD28
//-- Check end of CMD28
if(!Chk_CMDend(28, 1))
goto RECMD28;
rSDICmdSTA=0xa00; // Clear cmd_end(with rsp)
}
void Clr_Prt(void)
{
//-- Clear protection addr.0 ~ 262144(32*16*512)
//printf("[Clear protection(addr.0 ~ 262144) test]\n");
RECMD29:
//--Make ACMD
rSDICmdARG=0; // CMD29(addr)
rSDICmdCON=(0x1<<9)|(0x1<<8)|0x5d; //sht_resp, wait_resp, start, CMD29
//-- Check end of CMD29
if(!Chk_CMDend(29, 1))
goto RECMD29;
rSDICmdSTA=0xa00; // Clear cmd_end(with rsp)
}
?? 快捷鍵說明
復制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號
Ctrl + =
減小字號
Ctrl + -