sdi.c

三星s3c2460开发板完整功能测试代码

#include <stdio.h>
#include <string.h>

#include "option.h"
#include "2460addr.h"
#include "2460lib.h"
#include "sdi.h"
#include "PLL.h"

#define INICLK	400000
#define SDCLK	25000000	
//#define SDCLK	15000000	
//#define SDCLK	5000000	

#define MMCCLK	16800000 //PCLK=50.500000MHz:16.833333MHz, 52.500000MHz:17.500000MHz	
//#define MMCCLK	10000000 
//#define MMCCLK	5000000 


#define POL	0
#define INT	1
#define DMA	2
#define SDI_Tx_buffer (_NONCACHE_STARTADDRESS)
#define SDI_Rx_buffer (_NONCACHE_STARTADDRESS+(0x800000))

int CMD13(void);    // Send card status
int CMD9(void);

// Global variables
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;
volatile unsigned int block;
volatile unsigned int TR_end=0;

int Wide=0; // 0:1bit, 1:4bit
int MMC=1;  // 0:SD  , 1:MMC

int  Maker_ID;
char Product_Name[7]; 
int  Serial_Num;

volatile int RCA;

void Ch28_SD_MMC(void)
{  
    RCA=0;
    MMC=0;
    //block=10240;   //3072Blocks=1.5MByte, ((2Block=1024Byte)*1024Block=1MByte)
    //block=16;   //3072Blocks=1.5MByte, ((2Block=1024Byte)*1024Block=1MByte)
    block = 3072;
//    rPERIPU&=0xf5ffffff; //Confirm : Pull_up enabled for XmsSDIO,XsdDAT[3:0] 	    
    printf("\n[SDI test]\n"); 
	printf("rSDIDSTA0=%x\n",rSDIDSTA);


	SD_MMC_GPIO_Initial();

    if(!SD_card_init())
	return;
	
    if(!MMC)
    printf("\n[SD card test...PCLK:%d,INICLK:%d,SDCLK:%d]\n",PCLK,INICLK,SDCLK); 
    else
    printf("\n[MMC card test...PCLK:%d,INICLK:%d,MMCCLK:%d]\n",PCLK,INICLK,MMCCLK);
	
    TR_Buf_new();
/*
INOM:    
    //printf("How many blocks to test?(1~16)?");
    block=(unsigned int)GetIntNum();
    if((block==0)|block>16)
	goto INOM;
    //block=1;//tark
    //printf("\n");
*/

    //CMD13();
	
    Wt_Block();
    Rd_Block();
    View_Rx_buf();

    if(MMC)
	TR_Buf_new();
    
    if(MMC)
    {	
		rSDICON =rSDICON|((0x0<<6)|(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;//tark???
    rSDICSTA=0xffff;
	
}

void SD_MMC_GPIO_Initial(void)
{
	printf("SD/MMc GPIO initialize\n");
	rGPACON=(2<<16)|(2<<18)|(2<<20)|(2<<22)|(2<<24)|(2<<26);
	//rGPAPU|=(0x3f<<8);  //Pull-up disable
	printf("rGPACON=%x\n",rGPACON);
}

void TR_Buf_new(void)
{
    //-- Tx & Rx Buffer initialize
    int i;

    Tx_buffer = (unsigned int *)SDI_Tx_buffer;

    //for(i=0;i<2048;i++)	//128[word]*16[blk]=8192[byte]
    for(i=0;i<(block*128);i++)
		*(Tx_buffer+i)=i;    

    Flush_Rx_buf();
}

void Flush_Rx_buf(void)
{
    //-- Flushing Rx buffer 
    int i;

    Rx_buffer=(unsigned int *)SDI_Rx_buffer;

    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,cnt=0;
    Tx_buffer=(unsigned int *)SDI_Tx_buffer;
    Rx_buffer=(unsigned int *)SDI_Rx_buffer;

    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;
        }
        cnt++;
        if((cnt%128)==0)
        {
			printf(".");
			cnt = 0;
		}
    }
    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 */
    rSDIPRE=PCLK/(INICLK)-1;	// 400KHz
    //printf("Init. Frequency is %dHz\n",(PCLK/(rSDIPRE+1)));
    //rSDICON=(1<<4)|(1<<1)|1;	// Type B, FIFO reset, clk enable
    rSDICON=(0<<4)|1;	// Type B, clk enable
    rSDIFSTA=rSDIFSTA|(1<<16);	// 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
    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;
        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");
    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)
{
    unsigned int i,status;

    status=rSDIFSTA;
    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++;
	}
    }
//	printf("rSDIFSTA=0x%x\n", rSDIFSTA);	//YH 040221

    ClearPending(BIT_SDMMC_MS);
	rSUBSRCPND=BIT_SUB_SDMMC;
}

void __irq Wt_Int(void)
{
	ClearPending(BIT_SDMMC_MS);
	rSUBSRCPND=BIT_SUB_SDMMC;

    rSDIDAT=*Tx_buffer++;
    wt_cnt++;

    if(wt_cnt==128*block)
    {
	rINTMSK |= BIT_SDMMC_MS;
	rSDIDAT=*Tx_buffer;
	TR_end=1;
    }
}

void __irq DMA_end(void)
{
    rSUBSRCPND=(BIT_SUB_DMA2);
    ClearPending(BIT_DMA_SBUS);
    
    TR_end=1;
}

void Rd_Block(void)
{
    unsigned int 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=(unsigned int)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

    rSDICARG=0x0;	// CMD17/18(addr)

RERDCMD:
    switch(mode)
    {
	case POL:
	    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:
	    pISR_SDMMC_MS=(unsigned)Rd_Int;
//	    rINTMSK = ~(BIT_SDI);
	    rINTMSK = ~(BIT_SDMMC_MS);
	    rINTSUBMSK = ~(BIT_SUB_SDMMC);
	    
	    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_SDMMC_MS);
		rINTSUBMSK|=(BIT_SUB_SDMMC);
	    rSDIIMSK=0;	// All mask
	    break;

	case DMA:
	    pISR_DMA_SBUS=(unsigned)DMA_end;
	    rINTMSK = ~(BIT_DMA_SBUS);
	    rINTSUBMSK = ~(BIT_SUB_DMA2);

	    rDISRC2=(int)(SDIDAT);	// SDIDAT
	    rDISRCC2=(1<<1)+(1<<0);	// APB, fix
	    rDIDST2=(unsigned int)(Rx_buffer);	// Rx_buffer
	    rDIDSTC2=(0<<1)+(0<<0);	// AHB, inc
	    //rDCON2=(1<<31)+(0<<30)+(1<<29)+(0<<28)+(0<<27)+(1<<22)+(2<<20)+128*block;
	    rDCON2=(1<<31)+(0<<30)+(1<<29)+(1<<28)+(0<<27)+(1<<22)+(2<<20)+32*block;//BSW Burst mode
	    //handshake, sync PCLK, TC int, single tx, single service, SDI, H/W request, 
	    //auto-reload off, word, 128blk*num
	    rDMASKTRIG2=(0<<2)+(1<<1)+0;    //no-stop, DMA2 channel on, no-sw trigger 
   	    rDMAREQSEL2=(0xa<<1)|0x1;

	    //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);
	    rSDIDCON=(1<<24)|(2<<22)|(1<<19)|(1<<17)|(Wide<<16)|(1<<15)|(1<<14)|(2<<12)|(block<<0);//BSW Burst mode 
		// 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
	    {
		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(!TR_end);
		//printf("rSDIFSTA=0x%x\n",rSDIFSTA);
	    rINTSUBMSK |= (BIT_SUB_DMA2);
	    rINTMSK |= (BIT_DMA_SBUS);
	    TR_end=0;
	    rDMASKTRIG2=(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 detect
    //printf("rSDIFSTA,rSDIDSTA=0x%x,0x%x\n", rSDIFSTA,rSDIDSTA);
    rSDIFSTA=rSDIFSTA&0x200;	//Clear Rx FIFO Last data Ready, YH 040221	
    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=(2<<22)|(1<<19)|(0<<17)|(0<<16)|(2<<12);
	  rSDIDCON=(2<<22)|(1<<19)|(0<<17)|(0<<16)|(1<<14)|(2<<12);


    rSDICARG=0x0;   // CMD11(addr)
    rSDICCON=(0x1<<9)|(0x1<<8)|0x4b;   //sht_resp, wait_resp, dat, start, CMD11

    while(rd_cnt<128*block)
    {
	if( (rSDIDSTA&0x20) == 0x20 )
	{
	    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;
    rSDICSTA=0xa00;	// Clear cmd_end(with rsp)

    //-- Check end of DATA
//    rSDIDCON=(2<<22)|(1<<19)|(0<<17)|(0<<16)|(1<<14)|(0<<12);