?? sdi.c
字號:
#include <stdio.h>
#include <string.h>
#include "def.h"
#include "option.h"
#include "2413addr.h"
#include "system.h"
#include "console.h"
//#include "2440lib.h"
#include "sdi.h"
//YH 0811#define INICLK 300000
#define INICLK 300000
//#define NORCLK 25000000
#define SDCLK 24000000 //PCLK=49.392MHz
#define MMCCLK 15000000 //PCLK=49.392MHz
#define POL 0
#define INT 1
#define DMA 2
int CMD13(void); // Send card status
int CMD9(void);
// Global variables
//YH 0728 int *Tx_buffer; //128[word]*16[blk]=8192[byte]
//YH 0728 int *Rx_buffer; //128[word]*16[blk]=8192[byte]
unsigned int *Tx_buffer; //128[word]*16[blk]=8192[byte]
unsigned int *Rx_buffer; //128[word]*16[blk]=8192[byte]
volatile unsigned int rd_cnt;
volatile unsigned int wt_cnt=0;
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;
void Test_SDI(void)
{
U32 save_rGPECON;
int k;
RCA=0;
MMC=0;
printf("block = ");
block=(U32)GetIntNum();; //3072Blocks=1.5MByte, ((2Block=1024Byte)*1024Block=1MByte)
// block=13;
// save_rGPEUP=rGPEUP;
save_rGPECON=rGPECON;
//rGPEUP = 0xf83f; // SDCMD, SDDAT[3:0] => PU En.
rGPECON = 0xaaaaaaaa; //SDCMD, SDDAT[3:0]
// rGPECON = 0xaaa800aa; //SDCMD, SDDAT[3:0] => Input
printf("\n[SDI test]\n");
if(!SD_card_init())
return;
TR_Buf_new();
/*
INOM:
//printf("How many blocks to test?(1~16)?");
block=(U32)Uart_GetIntNum();
if((block==0)|block>16)
goto INOM;
//block=1;//tark
//printf("\n");
*/
//CMD13();
//YH 040227
// for(k=0;k<4;k++)
Wt_Block();
Rd_Block();
View_Rx_buf();
if(MMC)
TR_Buf_new();
if(MMC)
{
rSDICON |=(1<<5); // YH 0519, MMC Type SDCLK
Wt_Stream();
Rd_Stream();
View_Rx_buf();
}
Card_sel_desel(0); // Card deselect
if(!CMD9())
printf("Get CSD fail!!!\n");
rSDIDCON = 0;
rSDICmdSTA=0xffff;
// rGPEUP=save_rGPEUP;
rGPECON=save_rGPECON;
}
void TR_Buf_new(void)
{
//-- Tx & Rx Buffer initialize
int i, j;
int start = 0x03020100;
Tx_buffer=(unsigned int *)0x31000000;
j=0;
for(i=0;i<2048;i++) //128[word]*16[blk]=8192[byte]
*(Tx_buffer+i)=i+j;
// *(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=(unsigned 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;
Tx_buffer=(unsigned int *)0x31000000;
Rx_buffer=(unsigned int *)0x31800000;
printf("Check Rx data\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;
}
//YH 040227 printf(".");
}
if(!error)
printf(" O.K.\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 by pull up resister */
//YH 0816, Org rSDIPRE=PCLK/(2*INICLK)-1; // 400KHz
rSDIPRE=PCLK/(INICLK)-1; // 400KHz
printf("rSDIPRE=%d INICLK=%d PCLK = %d\n",rSDIPRE,INICLK, PCLK);
printf("Init. Frequency is %dHz\n",(PCLK/(rSDIPRE+1)));
// rSDICON=(1<<4)|(1<<1)|1; // Type B, FIFO reset, clk enable
rSDICON=(1<<4)|1; // Type B, clk enable
rSDIFSTA=rSDIFSTA|(1<<16); //YH 040223 FIFO reset
rSDIBSIZE=0x200; // 512byte(128word)
rSDIDTIMER=0x7fffff; // 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
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
rSDICmdARG=0x0; // CMD2(stuff bit)
rSDICmdCON=(0x1<<10)|(0x1<<9)|(0x1<<8)|0x42; //lng_resp, wait_resp, start, CMD2
//-- Check end of CMD2
if(!Chk_CMDend(2, 1))
goto RECMD2;
rSDICmdSTA=0xa00; // Clear cmd_end(with rsp)
printf("\nEnd id\n");
RECMD3:
//--Send RCA
rSDICmdARG=MMC<<16; // CMD3(MMC:Set RCA, SD:Ask RCA-->SBZ)
rSDICmdCON=(0x1<<9)|(0x1<<8)|0x43; // sht_resp, wait_resp, start, CMD3
//-- Check end of CMD3
if(!Chk_CMDend(3, 1))
goto RECMD3;
rSDICmdSTA=0xa00; // Clear cmd_end(with rsp)
//--Publish RCA
if(MMC) {
RCA=1;
//YH 0812 rSDIPRE=(PCLK/(MMCCLK)+1)-1; // YH 0716, Normal clock=20MHz
rSDIPRE=(PCLK/MMCCLK)-1; // YH 0812, Normal clock=20MHz
printf("MMC Frequency is %dHz\n",(PCLK/(rSDIPRE+1)));
}
else
{
RCA=( rSDIRSP0 & 0xffff0000 )>>16;
printf("RCA=0x%x\n",RCA);
rSDIPRE=PCLK/(SDCLK)-1; // Normal clock=25MHz
printf("SD Frequency is %dHz\n",(PCLK/(rSDIPRE+1)));
} //YH 0716
//--State(stand-by) check
if( rSDIRSP0 & 0x1e00!=0x600 ) // CURRENT_STATE check
goto RECMD3;
printf("\nIn stand-by\n");
// rSDIPRE=PCLK/(2*NORCLK)-1; // Normal clock=25MHz
//YH 0716 rSDIPRE=PCLK/(SDCLK)-1; // Normal clock=25MHz
//YH 0716 //printf("SD Frequency is %dMHz\n",(PCLK/(rSDIPRE+1)));
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:
rSDICmdARG=RCA<<16; // CMD7(RCA,stuff bit)
rSDICmdCON= (0x1<<9)|(0x1<<8)|0x47; // sht_resp, wait_resp, start, CMD7
//-- Check end of CMD7
if(!Chk_CMDend(7, 1))
goto RECMDS7;
rSDICmdSTA=0xa00; // Clear cmd_end(with rsp)
//--State(transfer) check
if( rSDIRSP0 & 0x1e00!=0x800 )
goto RECMDS7;
}
else
{
RECMDD7:
rSDICmdARG=0<<16; //CMD7(RCA,stuff bit)
rSDICmdCON=(0x1<<8)|0x47; //no_resp, start, CMD7
//-- Check end of CMD7
if(!Chk_CMDend(7, 0))
goto RECMDD7;
rSDICmdSTA=0x800; // Clear cmd_end(no rsp)
}
}
void __irq Rd_Int(void)
{
U32 i,status;
ClearPending(BIT_SDI);
status=rSDIFSTA;
//printf ("read_int status =0x%x \n",status);
//printf ("rd_cnt = %d \n",rd_cnt);
if( (status&0x200) == 0x200 ) // Check Last interrupt?
{
for(i=(status & 0x7f)/4;i>0;i--)
{
*Rx_buffer++=rSDIDAT;
rd_cnt++;
}
// printf("status1=0x%x\n", status);
// status=rSDIFSTA&0x200; //If you do like this, rSDIFSTA register will not be updated., YH 040221
rSDIFSTA=rSDIFSTA&0x200; //Clear Rx FIFO Last data Ready, YH 040221
// printf("rSDIFSTA=0x%x\n", rSDIFSTA);
}
else if( (status&0x80) == 0x80 ) // Check Half interrupt?
{
for(i=0;i<8;i++)
{
*Rx_buffer++=rSDIDAT;
rd_cnt++;
}
}
if(rd_cnt==(128*block))
{
rINTSUBMSK |=(BIT_SUB_SDI);
rINTMSK |= BIT_SDI;
}
ClearPending(BIT_SDI);
}
void __irq Wt_Int(void)
{
ClearPending(BIT_SDI);
rSDIDAT=*Tx_buffer++;
wt_cnt++;
// printf("wt_cnt = %d\n",wt_cnt);
if(wt_cnt==(128*block))
{
rINTSUBMSK |=(BIT_SUB_SDI);
rINTMSK |= BIT_SDI;
TR_end=1;
rSDIDAT=*Tx_buffer;
}
}
void __irq DMA_end(void)
{
ClearPending(BIT_DMA0);
TR_end=1;
}
void Rd_Block(void)
{
U32 mode;
int status;
rd_cnt=0;
printf("[Block read test]\n");
RE0:
printf("0:Polling read 1:Interrupt read 2:DMA read\nSelect the test mode?");
mode=(U32)GetIntNum();
printf("\n");
if(mode>2)
goto RE0;
// rSDICON = rSDICON|(1<<1); // FIFO reset
rSDIFSTA=rSDIFSTA|(1<<16); // FIFO reset
if(mode!=2)
rSDIDCON=(2<<22)|(1<<19)|(1<<17)|(Wide<<16)|(1<<14)|(2<<12)|(block<<0); //YH 040220
//Word Rx, Rx after cmd, blk, 4bit bus, Rx start, blk num, data start, data transmit mode
rSDICmdARG=0x0; // CMD17/18(addr)
RERDCMD:
switch(mode)
{
case POL:
if(block<2) // SINGLE_READ
{
rSDICmdCON=(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
{
rSDICmdCON=(0x1<<9)|(0x1<<8)|0x52; // sht_resp, wait_resp, dat, start, CMD18
if(!Chk_CMDend(18, 1)) //-- Check end of CMD18
goto RERDCMD;
}
rSDICmdSTA=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:
pISR_SDI=(unsigned)Rd_Int;
if(block<2) // SINGLE_READ
{
rSDICmdCON=(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
{
rSDICmdCON=(0x1<<9)|(0x1<<8)|0x52; // sht_resp, wait_resp, dat, start, CMD18
if(!Chk_CMDend(18, 1)) //-- Check end of CMD18
goto RERDCMD;
}
rSDICmdSTA=0xa00; // Clear cmd_end(with rsp)
rINTMSK = ~(BIT_SDI);
rINTSUBMSK =~(BIT_SUB_SDI);
rSDIINTMSK=5; // Last & Rx FIFO half int.
while(rd_cnt<128*block);
rINTMSK |= (BIT_SDI);
rINTSUBMSK |=(BIT_SUB_SDI);
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)(SDIDAT); // SDIDAT
rDISRCC0=(1<<1)+(1<<0); // APB, fix
rDIDST0=(U32)(Rx_buffer); // Rx_buffer
rDIDSTC0=(0<<1)+(0<<0); // AHB, inc
rDCON0=(1<<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=(2<<22)|(1<<19)|(1<<17)|(Wide<<16)|(1<<15)|(2<<12)|(block<<0);
rSDIDCON=(2<<22)|(1<<19)|(1<<17)|(Wide<<16)|(1<<15)|(1<<14)|(2<<12)|(block<<0);
// Word Rx, Rx after rsp, blk, 4bit bus, dma enable, Rx start, blk num, Data start, data receive mode, YH 040220
if(block<2) // SINGLE_READ
{
rSDICmdCON=(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
{
rSDICmdCON=(0x1<<9)|(0x1<<8)|0x52; // sht_resp, wait_resp, dat, start, CMD18
if(!Chk_CMDend(18, 1)) //-- Check end of CMD18
goto RERDCMD;
}
rSDICmdSTA=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(!Chk_DATend())
printf("dat error\n");
rSDIDCON=rSDIDCON&~(7<<12); //YH 040220, Clear Data Transfer mode => no operation, Cleata Data Transfer start
rSDIFSTA=rSDIFSTA&0x200; //Clear Rx FIFO Last data Ready, YH 040221
rSDIDSTA=0x10; // Clear data Tx/Rx end detect
if(block>1)
{
RERCMD12:
//--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 RERCMD12;
rSDICmdSTA=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=(2<<22)|(1<<19)|(0<<17)|(0<<16)|(2<<12);
rSDIDCON=(2<<22)|(1<<19)|(0<<17)|(0<<16)|(1<<14)|(2<<12);
rSDICmdARG=0x0; // CMD11(addr)
rSDICmdCON=(0x1<<9)|(0x1<<8)|0x4b; //sht_resp, wait_resp, dat, start, CMD11
while(rd_cnt<128*block)
{
if( (rSDIDSTA&0x20) == 0x20 )
{
?? 快捷鍵說明
復制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號
Ctrl + =
減小字號
Ctrl + -