sdi.c

三星2440开发板的BIOS和测试例程源码

#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