?? sdi.c
字號:
#include "def.h"
#include "option.h"
#include "2410addr.h"
#include "2410lib.h"
#include "sdi.h"
#define SD_DEBUG 0
#define INICLK 400000//300000
#define NORCLK 20000000
#define POL 0
#define INT 1
#define DMA 2
int CMD13(void); // Send card status
int CMD9(void);
// Global variables
int *Tx_buffer; //128[word]*16[blk]=8192[byte]
int *Rx_buffer; //128[word]*16[blk]=8192[byte]
volatile unsigned int rd_cnt;
volatile unsigned int wt_cnt;
volatile unsigned int block;
volatile unsigned int TR_end=0;
int Wide=0; // 0:1bit, 1:4bit
int MMC=0; // 0:SD , 1:MMC
int Maker_ID;
char Product_Name[7];
int Serial_Num;
volatile int RCA;
static int blk_offset;
void SDI_test(void)
{
RCA=0;
MMC=0;
rGPEUP = 0xf83f; // The pull up
rGPECON = 0xaaaaaaaa;
rSDICSTA = 0xffff;
rSDIDSTA = 0xffff;
printf("\nSDI CARD test\n");
if( !SD_card_init() )
return;
TR_Buf_new();
block = 1 ;
printf("Blocks = %d\n", block);
blk_offset = 0x2000;
//CMD13();
Wt_Block();
Rd_Block();
View_Rx_buf();
#ifdef TEST_MMC_STREAM
if(MMC)
TR_Buf_new();
if(MMC)
{
Wt_Stream();
Rd_Stream();
View_Rx_buf();
}
#endif
Card_sel_desel(0); // Card deselect
rSDICARG = RCA<<16;
rSDICCON = (0x1<<10)|(0x1<<9)|(0x1<<8)|0x4a;
if(Chk_CMDend(10, 1))
{
#if( SD_DEBUG )
printf("CID = %x,%x,%x,%x\n", rSDIRSP0, rSDIRSP1, rSDIRSP2, rSDIRSP3);
#endif
Delay( 0 ) ;
}
else
puts("Get cid fail!\n");
if(!CMD9())
printf("Get CSD fail!!!\n");
rSDIDCON=0;//tark???
rSDICSTA=0xffff;
}
void TR_Buf_new(void)
{
//-- Tx & Rx Buffer initialize
int i, j;
// int start = 0x03020100;
Tx_buffer=(int *)0x31000000;
j=0;
for(i=0;i<2048;i++) //128[word]*16[blk]=8192[byte]
*(Tx_buffer+i)=i;
// *(Tx_buffer+i)=0x5555aaaa;
Flush_Rx_buf();
/*
for(i=0;i<20;i++){
for(j=0;j<128;j++){
Tx_buffer[j+i*128]=start;
if(j % 64 == 63) start = 0x0302010;
else start = start + 0x04040404;
}
start = 0x03020100;
}
*/
}
void Flush_Rx_buf(void)
{
//-- Flushing Rx buffer
int i;
Rx_buffer=(int *)0x31800000;
for(i=0;i<2048;i++) //128[word]*16[blk]=8192[byte]
*(Rx_buffer+i)=0;
// printf("\n--End Rx buffer flush\n");
}
void View_Rx_buf()
{
//-- Display Rx buffer
int i,error=0;
/*
for(i=0;i<2048;i++)
printf("RB[%02x]=%x,",Rx_buffer[i]);
*/
Tx_buffer=(int *)0x31000000;
Rx_buffer=(int *)0x31800000;
printf("Check Rx data\n\n");
printf("The follow is the data writed to SD Card just now:\n");
for(i=0;i<128*block;i++)
{
if(Rx_buffer[i] != Tx_buffer[i])
{
printf("\nTx/Rx error\n");
printf("%d:Tx-0x%08x, Rx-0x%08x\n",i,Tx_buffer[i], Rx_buffer[i]);
error=1;
break;
}
//printf(".");
if( (i%15)==0 ) printf( "\n" ) ;
printf("%02x,", Rx_buffer[i]);
}
if(!error)
printf("\n\nSD CARD Write and Read test is OK!\n");
}
void View_Tx_buf(void)
{
//-- Display Tx buffer
int i;
for(i=0;i<2048;i++)
printf("TB[%02x]=%x,",Tx_buffer[i]);
}
int SD_card_init(void)
{
//-- SD controller & card initialize
int i;
// char key;
/* Important notice for MMC test condition */
/* Cmd & Data lines must be enabled pull up resister */
rSDIPRE=PCLK/(2*INICLK)-1; // 400KHz
rSDICON=(1<<4)|(1<<1)|1; // Type B, FIFO reset, clk enable
rSDIBSIZE=0x200; // 512byte(128word)
rSDIDTIMER=0xffff; // Set timeout count
for(i=0;i<0x1000;i++); // Wait 74SDCLK for MMC card
//printf("rSDIRSP0=0x%x\n",rSDIRSP0);
CMD0();
printf("\nIn idle\n");
//-- Check MMC card OCR
if(Chk_MMC_OCR())
{
printf("\nIn MMC ready\n");
MMC=1;
goto RECMD2;
}
//printf("MMC check end!!\n");
//-- Check SD card OCR
//DbgPause(0);
if(Chk_SD_OCR())
printf("\nIn SD ready\n");
else
{
printf("\nInitialize fail\nNo Card assertion\n");
return 0;
}
RECMD2:
//-- Check attaced cards, it makes card identification state
rSDICARG=0x0; // CMD2(stuff bit)
rSDICCON=(0x1<<10)|(0x1<<9)|(0x1<<8)|0x42; //lng_resp, wait_resp, start, CMD2
//-- Check end of CMD2
if(!Chk_CMDend(2, 1))
goto RECMD2;
//rSDICSTA=0xa00; // Clear cmd_end(with rsp)
printf("\nEnd id\n");
RECMD3:
//--Send RCA
rSDICARG=MMC<<16; // CMD3(MMC:Set RCA, SD:Ask RCA-->SBZ)
rSDICCON=(0x1<<9)|(0x1<<8)|0x43; // sht_resp, wait_resp, start, CMD3
//-- Check end of CMD3
if(!Chk_CMDend(3, 1))
goto RECMD3;
//rSDICSTA=0xa00; // Clear cmd_end(with rsp)
//--Publish RCA
if(MMC)
RCA=1;
else
RCA=( rSDIRSP0 & 0xffff0000 )>>16;
#if( SD_DEBUG )
printf("RCA=0x%x\n",RCA);
#endif
//--State(stand-by) check
if( rSDIRSP0 & 0x1e00!=0x600 ) // CURRENT_STATE check, modified by hzh???
goto RECMD3;
// printf("rSDIRSP0=%x, %x, %x\n", rSDIRSP0, rSDIRSP0 & 0x1e00, rSDIRSP0 & 0x1e00!=0x600);
printf("\nIn stand-by\n");
rSDIPRE=PCLK/(2*NORCLK)-1; // Normal clock=25MHz
Card_sel_desel(1); // Select
if(!MMC)
Set_4bit_bus();
else
Set_1bit_bus();
return 1;
}
void Card_sel_desel(char sel_desel)
{
//-- Card select or deselect
if(sel_desel)
{
RECMDS7:
rSDICARG=RCA<<16; // CMD7(RCA,stuff bit)
rSDICCON= (0x1<<9)|(0x1<<8)|0x47; // sht_resp, wait_resp, start, CMD7
//-- Check end of CMD7
if(!Chk_CMDend(7, 1))
goto RECMDS7;
//rSDICSTA=0xa00; // Clear cmd_end(with rsp)
//--State(transfer) check
if( rSDIRSP0 & 0x1e00!=0x800 ) //???
goto RECMDS7;
}
else
{
RECMDD7:
rSDICARG=0<<16; //CMD7(RCA,stuff bit)
rSDICCON=(0x1<<8)|0x47; //no_resp, start, CMD7
//-- Check end of CMD7
if(!Chk_CMDend(7, 0))
goto RECMDD7;
//rSDICSTA=0x800; // Clear cmd_end(no rsp)
}
}
void __irq Rd_Int(void)
{
U32 i,status;
status=rSDIFSTA;
if( (status&0x200) == 0x200 ) // Check Last interrupt?
{
for(i=(status & 0x7f)/4;i>0;i--) //read reamin
{
*Rx_buffer++=rSDIDAT;
rd_cnt++;
}
}
else if( (status&0x80) == 0x80 ) // Check Half interrupt?
{
for(i=0;i<8;i++)
{
*Rx_buffer++=rSDIDAT;
rd_cnt++;
}
}
ClearPending(BIT_SDI);
}
void __irq Wt_Int(void)
{
ClearPending(BIT_SDI);
rSDIDAT=*Tx_buffer++;
wt_cnt++;
if(wt_cnt==128*block)
{
rINTMSK |= BIT_SDI;
rSDIDAT=*Tx_buffer;
TR_end=1;
}
}
void __irq DMA_end(void)
{
ClearPending(BIT_DMA0);
rSDIDCON &= ~0x8000; //clear DMA bit, added by hzh
TR_end=1;
}
void Rd_Block(void)
{
U32 mode;
int status;
rd_cnt=0;
printf("[Block read test]\n");
mode = 0 ;
printf("Mode : Polling read\n");
rSDICON |= rSDICON|(1<<1); // FIFO reset
// mode=2;//tark
if(mode!=2)
rSDIDCON=(1<<19)|(1<<17)|(Wide<<16)|(2<<12)|(block<<0);
// Rx after cmd, blk, 4bit bus, Rx start, blk num
rSDICARG=blk_offset*0x200; // CMD17/18(addr)
RERDCMD:
switch(mode)
{
case POL:
puts("Poll read\n");
if(block<2) // SINGLE_READ
{
rSDICCON=(0x1<<9)|(0x1<<8)|0x51; // sht_resp, wait_resp, dat, start, CMD17
if(!Chk_CMDend(17, 1)) //-- Check end of CMD17
goto RERDCMD;
}
else // MULTI_READ
{
rSDICCON=(0x1<<9)|(0x1<<8)|0x52; // sht_resp, wait_resp, dat, start, CMD18
if(!Chk_CMDend(18, 1)) //-- Check end of CMD18
goto RERDCMD;
}
//rSDICSTA=0xa00; // Clear cmd_end(with rsp)
while(rd_cnt<128*block) // 512*block bytes
{
if((rSDIDSTA&0x20)==0x20) // Check timeout
{
rSDIDSTA=0x1<<0x5; // Clear timeout flag
break;
}
status=rSDIFSTA;
if((status&0x1000)==0x1000) // Is Rx data?
{
*Rx_buffer++=rSDIDAT;
rd_cnt++;
}
}
break;
case INT:
puts("Interrupt read\n");
pISR_SDI=(unsigned)Rd_Int;
rINTMSK = ~(BIT_SDI);
rSDIIMSK=5; // Last & Rx FIFO half int.
if(block<2) // SINGLE_READ
{
rSDICCON=(0x1<<9)|(0x1<<8)|0x51; // sht_resp, wait_resp, dat, start, CMD17
if(!Chk_CMDend(17, 1)) //-- Check end of CMD17
goto RERDCMD;
}
else // MULTI_READ
{
rSDICCON=(0x1<<9)|(0x1<<8)|0x52; // sht_resp, wait_resp, dat, start, CMD18
if(!Chk_CMDend(18, 1)) //-- Check end of CMD18
goto RERDCMD;
}
//rSDICSTA=0xa00; // Clear cmd_end(with rsp)
while(rd_cnt<128*block);
rINTMSK |= (BIT_SDI);
rSDIIMSK=0; // All mask
break;
case DMA:
puts("Dma read\n");
pISR_DMA0=(unsigned)DMA_end;
rINTMSK = ~(BIT_DMA0);
rDISRC0=(int)(SDIDAT); // SDIDAT
rDISRCC0=(1<<1)+(1<<0); // APB, fix
rDIDST0=(U32)(Rx_buffer); // Rx_buffer
rDIDSTC0=(0<<1)+(0<<0); // AHB, inc
rDCON0=(1UL<<31)+(0<<30)+(1<<29)+(0<<28)+(0<<27)+(2<<24)+(1<<23)+(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, DMA2 channel on, no-sw trigger
rSDIDCON=(1<<19)|(1<<17)|(Wide<<16)|(1<<15)|(2<<12)|(block<<0);
// Rx after rsp, blk, 4bit bus, dma enable, Rx start, blk num
if(block<2) // SINGLE_READ
{
rSDICCON=(0x1<<9)|(0x1<<8)|0x51; // sht_resp, wait_resp, dat, start, CMD17
if(!Chk_CMDend(17, 1)) //-- Check end of CMD17
goto RERDCMD;
}
else // MULTI_READ
{
rSDICCON=(0x1<<9)|(0x1<<8)|0x52; // sht_resp, wait_resp, dat, start, CMD18
if(!Chk_CMDend(18, 1)) //-- Check end of CMD18
return;//goto RERDCMD;
}
#if( SD_DEBUG )
printf("%x,%x,%x,%x,%x\n", rSDICCON, rSDICSTA, rSDIDCON, rSDIFSTA, block);
printf("%x,%x,%x,%x,%x,%x,%x\n", rDISRCC0, rDISRC0, rDIDSTC0, rDIDST0, rDCON0, rDMASKTRIG0, rDSTAT0);
#endif
//rSDICSTA=0xa00; // Clear cmd_end(with rsp)
while(!TR_end);
//printf("rSDIFSTA=0x%x\n",rSDIFSTA);
rINTMSK |= (BIT_DMA0);
TR_end=0;
rDMASKTRIG0=(1<<2); //DMA0 stop
break;
default:
break;
}
//-- Check end of DATA
if(mode==5) {
int dsta, fsta, dcnt;
dsta = rSDIDSTA;
fsta = rSDIFSTA;
dcnt = rSDIDCNT;
#if( SD_DEBUG )
printf("SDIDSTA=%x,SDIFSTA=%x,SDIDCNT=%x\n", dsta, fsta, dcnt);
#endif
if((dcnt&0xffffff)!=0) {
int i, d;
i =0 ;
while(rSDIDSTA&1) {
d = rSDIDAT;
i++;
}
/* while(rSDIFSTA&0x1000)
d = rSDIDAT;
while(rSDIDCNT&0xffffff)
d = rSDIDAT;
while(rSDIFSTA&0x1000)
d = rSDIDAT;*/
dsta = rSDIDSTA;
fsta = rSDIFSTA;
dcnt = rSDIDCNT;
#if( SD_DEBUG )
printf("SDIDSTA=%x,SDIFSTA=%x,SDIDCNT=%x,read cont=%d\n", dsta, fsta, dcnt, i);
#endif
}
}
printf("chk data end\n");
if(!Chk_DATend())
printf("error\n");
rSDIDSTA=0x10; // Clear data Tx/Rx end
if(block>1)
{
RERCMD12:
//--Stop cmd(CMD12)
rSDICARG=0x0; //CMD12(stuff bit)
rSDICCON=(0x1<<9)|(0x1<<8)|0x4c;//sht_resp, wait_resp, start, CMD12
//-- Check end of CMD12
if(!Chk_CMDend(12, 1))
goto RERCMD12;
//rSDICSTA=0xa00; // Clear cmd_end(with rsp)
}
}
void Rd_Stream(void) // only for MMC, 3blk read
{
// int i;
int status, rd_cnt=0;
if(MMC!=1)
{
printf("Stream read command supports only MMC!\n");
return;
}
printf("\n[Stream read test]\n");
RECMD11:
rSDIDCON=(1<<19)|(0<<17)|(0<<16)|(2<<12);
rSDICARG=0x0; // CMD11(addr)
rSDICCON=(0x1<<9)|(0x1<<8)|0x4b; //sht_resp, wait_resp, dat, start, CMD11
?? 快捷鍵說明
復制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號
Ctrl + =
減小字號
Ctrl + -