sdcarddriver.c

凌阳SPCE3200多媒体开发板自带源程序。共安排了32个子目录

#include ".\System\SystemHeader.h"
#include ".\Peripheral\PeripheralHeader.h"




// SDCard
	    #define DMA_M2P					0x00000000
		#define DMA_P2M					0x00000001
		#define DMA_AUTO				0x00000000
		#define DMA_REQ					0x00000002
		#define DMA_CON					0x00000000
		#define DMA_FIX					0x00000004
		#define DMA_SINGLE_BUF			0x00000000
		#define DMA_DOUBLE_BUF			0x00000008
		#define DMA_8BIT				0x00000000
		#define DMA_16BIT				0x00000010
		#define DMA_32BIT				0x00000020
		#define DMA_32BIT_BURST			0x00000030
		#define DMA_IRQOFF				0x00000000
		#define DMA_IRQON				0x00000040
		#define DMA_OFF					0x00000000
		#define DMA_ON					0x00000080

U32		rca;
S32 	g_sd_dmabusy;

S32		SDCardTotalSector;
S32		gSDCardInsert;
S32		gSDCardPresent;
S32		gSDCardWriteProtect;


S32 SDDrv_ReadSector(U32 addr, U32 blocknum, U8 *outaddr);
S32 SDDrv_WriteSector(U32 addr, U32 blocknum, U8 *outaddr);
S32 SDDrv_Initial(void);
S32 SDDrv_GetMemSize(void);
S32 SDDrv_GetSpeed(void);

//S32		ReadSectors(U32 block, U32 blocknum, U8 *outaddr);
//S32		WriteSectors(U32 block, U32 blocknum, U8 *outaddr);

S32		DrvSDCReadMulCommand(U32 block);
S32		DrvSDCReadMulData(U8 *outaddr);
S32		DrvSDCReadMulData_INT(U8 *outaddr);
S32		DrvSDCReadMulStop(void);
S32		DrvSDCWriteMulCommand(U32 block);
S32		DrvSDCWriteMulData(U8 *outaddr);
S32		DrvSDCWriteMulData_INT(U8 *outaddr);
S32		DrvSDCWriteMulStop(void);





S32 WaitSDStatus(U32 pollbit)
{
	S32 i;
 
	i = 0;
	do {
		i = i + 1;
		if(!gSDCardInsert)
			return 1;
	} while (((*P_SD_INT_STATUS & pollbit) == 0) && (i<60000));
	
	if (i==600000) 
		return 1;

	if ((*P_SD_INT_STATUS & (MASK_S_RespIdxError|MASK_S_RespCRCError|MASK_S_DataCRCError|MASK_S_TimeOut)) != 0) 
		return 1;
	return 0;
}	

S32 SDCommand(U32 commandset, U32 arg, U32* outaddr)
{
	// Write Argument First
	*P_SD_ARGUMENT_DATA = arg;
	*P_SD_COMMAND_SETUP = commandset;
	if (WaitSDStatus(MASK_S_CmdComplete)) 
	{
		*P_SD_INT_STATUS = MASK_S_ClrAllBits;
		return 1;
	}
	*outaddr = *P_SD_RESPONSE_DATA;
	*P_SD_INT_STATUS = MASK_S_ClrAllBits;
	return 0;
}

S32 SDCommandr2(U32 commandset, U32 arg, U32* outaddr)
{
	S32 i;
	
	// Write Argument First
	*P_SD_ARGUMENT_DATA = arg;
	*P_SD_COMMAND_SETUP = commandset;
	for (i=0;i<4;i++) 
	{
		if(WaitSDStatus(MASK_S_RespRegFull))
			return 1;
		*outaddr = *P_SD_RESPONSE_DATA;
		outaddr++;
	}
	if (WaitSDStatus(MASK_S_CmdComplete)) 
		return 1;
		
	*P_SD_INT_STATUS = MASK_S_ClrAllBits;
	return 0;
}

S32 SDCommandr3(U32 commandset, U32 arg, U32* outaddr)
{
	S32 i;
	
	g_sd_dmabusy = 1;
	
	// Write Argument First
	*P_SD_ARGUMENT_DATA = arg;
	*P_SD_COMMAND_SETUP = commandset;

	i = 0;
	while ((*P_SD_INT_STATUS & MASK_S_DataBufFull) == 0)
	{
		i = i + 1;
		if(i == 600000)
			return 1;
		
		if(!gSDCardInsert)
			return 1;
	}
	
	*outaddr = *P_SD_RX_DATA;
	
	i = 0;
	while ((*P_SD_INT_STATUS & MASK_S_DataBufFull) == 0)
	{
		i = i + 1;
		if(i == 600000)
			return 1;
		
		if(!gSDCardInsert)
			return 1;
	}
	
	*(outaddr+1) = *P_SD_RX_DATA;
	
	if (WaitSDStatus(MASK_S_DataComplete)) 
	{
		*P_SD_INT_STATUS = MASK_S_ClrAllBits;
		return 1;
	}

	*P_SD_INT_STATUS = MASK_S_ClrAllBits;
	return 0;
}

extern void invalid_cache(U32 addr);

S32 SDDrv_ReadSector(U32 sector, U32 sector_num, U8 *buf)
{
	S32 i, ret;
	
	if(DrvSDCReadMulCommand(sector))
		return 1;
	
	
	for(i=0; i<sector_num; i++)
	{
		ret = DrvSDCReadMulData(buf+i*512);
		//ret = ReadSectors(sector+i, 1, buf+i*512);
		if(ret == 1)
		{
			DrvSDCReadMulStop();	
			return ret;
		}
	}		
	
	if(DrvSDCReadMulStop())
		return 1;
	return 0;
}

S32		DrvSDCReadMulCommand(U32 block)
{
	U32 response[4];
	
	g_sd_dmabusy = 1;

	SDCommand(MASK_CMD7, rca, response);
	
	*P_SD_ARGUMENT_DATA = rca;
	*P_SD_COMMAND_SETUP = MASK_CMD13;
	
	while((*P_SD_INT_STATUS & MASK_S_CmdComplete) == 0x00);
	response[0] = *P_SD_RESPONSE_DATA;
	
	*P_SD_INT_STATUS = MASK_S_ClrAllBits;
	
	// Write Argument First
//	*P_SDC_Arg = block<<9;
//	*P_SDC_Command = MASK_CMD18;
//	*P_SDC_Command = MASK_CMD17;
	if(SDCommand(MASK_CMD18,block<<9,response))
		return 1;	
	
	return 0;
}

S32		DrvSDCReadMulData(U8 *outaddr)
{
	U32	i;
	U32 *realaddr;
	
	i=(U32) outaddr;
	if((i & 0x03) == 0x00)
	{
		// USE DMA
		*P_DMA_CHANNEL0_CTRL = 0x0000;
		
		*P_DMA_AHB_SA0BA = (U32)outaddr;
		*P_DMA_AHB_EA0BA = (U32)outaddr + (1 << 9) - 4;
		*P_DMA_APB_SA0 = 0x88180004;
	
		//*P_DMA_CR1 = DMA_P2M|DMA_REQ|DMA_FIX|DMA_SINGLE_BUF|DMA_32BIT|DMA_IRQOFF|DMA_ON;
		*P_DMA_CHANNEL0_CTRL = DMA_P2M|DMA_REQ|DMA_FIX|DMA_SINGLE_BUF|DMA_32BIT_BURST|DMA_IRQOFF|DMA_ON;
	
		// Loop until DMA interrupt is set
		while ((*P_DMA_INT_STATUS  & 0x1) == 0)
		{
			if(!gSDCardInsert)
				return 1;
		}
	
		// Clear Interrupt and Disable DMA channel
		*P_DMA_INT_STATUS  = 0x1;
		*P_DMA_CHANNEL0_CTRL = 0x0000;	
	}
	else
	{
		// Do Not USE DMA
		U32	DataCount;
		U32	Data;
		
		DataCount=512 >> 2;	// DataCount = 512 Byte / 4
		
		do
		{
			if(WaitSDStatus(MASK_S_DataBufFull))
				return 1;
			Data=*P_SD_RX_DATA;
			*outaddr++ = (char) Data;
			Data=Data >> 8;
			*outaddr++ = (char) Data;
			Data=Data >> 8;
			*outaddr++ = (char) Data;
			Data=Data >> 8;
			*outaddr++ = (char) Data;
			
			DataCount--;
		}while(DataCount != 0x00);	
	}
	
	
	realaddr = (U32)outaddr & 0x8fffffff;
	invalid_cache(realaddr);
	
	i = 0;
	while((*P_SD_INT_STATUS & MASK_S_DataComplete) == 0x00)
	{
		i++;
		if( i == 0xFFFFFF)
			return 1;
	}
	*P_SD_INT_STATUS = MASK_S_ClrAllBits;
	
	return 0;
}

S32		DrvSDCReadMulData_INT(U8 *outaddr)
{
	
	// USE DMA
	*P_DMA_CHANNEL0_CTRL = 0x0000;
	
	*P_DMA_AHB_SA0BA = (U32)outaddr;
	*P_DMA_AHB_EA0BA = (U32)outaddr + ( 512 ) - 4;
	*P_DMA_APB_SA0 = 0x88180004;
	
	*P_DMA_CHANNEL0_CTRL = DMA_P2M|DMA_REQ|DMA_FIX|DMA_SINGLE_BUF|DMA_32BIT_BURST|DMA_IRQON|DMA_ON;
	
	return 0;
}

S32		DrvSDCReadMulStop(void)
{
	U32 response[4];
	U32 loopcnt;
	
	// Stop the controller
	*P_SD_COMMAND_SETUP = MASK_CMDSTOP;

	// Loop until controller idle
	while(*P_SD_INT_STATUS & MASK_S_ControllerBusy)
		if(!gSDCardInsert)
			return 1;

	*P_SD_INT_STATUS = MASK_S_ClrAllBits;
	
	// Stop the card
	SDCommand(MASK_CMD12, 0x00000000, response);
	
	
	loopcnt=0;
	do
	{
		if(SDCommand(MASK_CMD13, rca, response))
			return 1;
		loopcnt++;
		
		if(loopcnt == 0xFFFFFF)
			return 1;
		
	} while (response[0] != 0x0900);
	SDCommand(MASK_CMD7, rca, response);
	return 0;
}

S32 SDDrv_WriteSector(U32 block, U32 blocknum, U8 *outaddr)
{
	S32 i, ret;
	
	if(DrvSDCWriteMulCommand(block))
		return 1;
	
	for(i=0; i<blocknum; i++)	
	{
		ret = DrvSDCWriteMulData(outaddr+i*512);
		if(ret == 1)
		{
			DrvSDCWriteMulStop();
			return ret;
		}
	}		
	
	if(DrvSDCWriteMulStop())
		return 1;
	
	return 0;
	
}

S32		DrvSDCWriteMulCommand(U32 block)
{
	U32 	response[4];
	
	SDCommand(MASK_CMD7, rca, response);
	g_sd_dmabusy = 1;	
	
	*P_SD_ARGUMENT_DATA = rca;
	*P_SD_COMMAND_SETUP = MASK_CMD13;
	
	while((*P_SD_INT_STATUS & MASK_S_CmdComplete) == 0x00);
	response[0] = *P_SD_RESPONSE_DATA;
	
	*P_SD_INT_STATUS = MASK_S_ClrAllBits;
	
	// Write Argument First
//	*P_SDC_Arg = block<<9;
//	*P_SDC_Command = MASK_CMD25;
	if(SDCommand(MASK_CMD25,block<<9,response))
		return 1;
	
	return 0;
}

S32		DrvSDCWriteMulData(U8 *outaddr)
{
	U32 	i;
	
	i = 0;
	while((*P_SD_INT_STATUS & MASK_S_CardBusy) != 0x00)
	{
		i++;
		if(i == 0xFFFFFF)
			return 1;
	}
	
	i=(U32) outaddr;
	if((i & 0x03) == 0)
	{
		// USE DMA
		*P_DMA_CHANNEL0_CTRL = 0x0000;
		
		*P_DMA_AHB_SA0BA = (U32)outaddr;
		*P_DMA_AHB_EA0BA = (U32)outaddr + ( 512 ) - 4;
		*P_DMA_APB_SA0 = 0x88180000;
		*P_DMA_CHANNEL0_CTRL = DMA_M2P|DMA_REQ|DMA_FIX|DMA_SINGLE_BUF|DMA_32BIT_BURST|DMA_IRQOFF|DMA_ON;
	
		// Loop until DMA interrupt is set
		while ((*P_DMA_INT_STATUS & 0x1) == 0)
		{
			if(!gSDCardInsert)
				return 1;
		}
	
		// Clear Interrupt and Disable DMA channel
		*P_DMA_INT_STATUS = 0x1;
		*P_DMA_CHANNEL0_CTRL = 0x0000;
		
	}
	else
	{
		// Do not USE DMA
		
		U32	DataCount;
		U32	Data;
		
		
		DataCount=512 >> 2;	// DataCount = 512 Byte / 4
		do
		{
			if(WaitSDStatus(MASK_S_DataBufEmpty))
				return 1;
			
			Data=(U32) *outaddr;
			outaddr++;
			Data |= ((U32) *outaddr)<<8;
			outaddr++;
			Data |= ((U32) *outaddr)<<16;
			outaddr++;
			Data |= ((U32) *outaddr)<<24;
			outaddr++;
			
			*P_SD_TX_DATA=Data;
			
			DataCount--;
		}while(DataCount != 0x00);
	}
	
	i = 0;
	while((*P_SD_INT_STATUS & MASK_S_DataComplete) == 0x00)
	{
		i++;
		if( i == 20000)
			return 1;
	}
	*P_SD_INT_STATUS = MASK_S_ClrAllBits;
	
	return 0;
}

S32		DrvSDCWriteMulData_INT(U8 *outaddr)
{
	U32 	i;
	
	i = 0;
	while((*P_SD_INT_STATUS & MASK_S_CardBusy) != 0x00)
	{
		i++;
		if(i == 0xFFFFFF)
			return 1;
	}
	
	
	// USE DMA
	*P_DMA_CHANNEL0_CTRL = 0x0000;
	
	*P_DMA_AHB_SA0BA = (U32)outaddr;
	*P_DMA_AHB_EA0BA = (U32)outaddr + (1 << 9) - 4;
	*P_DMA_APB_SA0 = 0x88180000;
	*P_DMA_CHANNEL0_CTRL = DMA_M2P|DMA_REQ|DMA_FIX|DMA_SINGLE_BUF|DMA_32BIT_BURST|DMA_IRQON|DMA_ON;
	
	return 0;
}

S32		DrvSDCWriteMulStop(void)
{
	U32 	i;
	U32 	response[4];
	
	i = 0;
	while((*P_SD_INT_STATUS & MASK_S_CardBusy) != 0x00)
	{
		i++;
		if(i == 0xFFFFFF)
			return 1;
	}
	
	// Stop the controller
	*P_SD_COMMAND_SETUP = MASK_CMDSTOP;

	// Loop until controller idle
	while(*P_SD_INT_STATUS & MASK_S_ControllerBusy);
	
	*P_SD_INT_STATUS = MASK_S_ControllerBusy;
	
	// Stop the card
	if(SDCommand(MASK_CMD12, 0x00000000, response))
		return 1;
		
	i = 0;
	do {
		
		*P_SD_INT_STATUS=MASK_S_ClrAllBits;
		if(SDCommand(MASK_CMD13, rca, response))
			return 1;
		
		i++;
		if(i == 60000)
			return 1;
	} while (response[0] != 0x0900);
	
	SDCommand(MASK_CMD7, rca, response);
	return 0;
}


S32 SDDrv_GetMemSize(void)
{

	return SDCardTotalSector;
}


S32 SDDrv_GetSpeed(void)
{
	U32 response[4], tranunit, timevalue, maxspeed;

	U32 SpeedTable[]={
		0, 10, 12, 13, 15, 20, 25, 30, 35, 40, 45, 50, 55, 60, 70, 80,		
	};
	
	U32 TranTable[]={
		1, 10, 100, 1000,
	};
	
	SDCommand(MASK_CMD7, 0x00000000, response);
	
	SDCommandr2(MASK_CMD9, rca, response);

	timevalue = ((response[0] & 0x00000078)>>3);
	tranunit=response[0] & 0x00000007;
	
	maxspeed = SpeedTable[timevalue] * TranTable[tranunit] / 100;
	
	if ((timevalue == 0) || (tranunit > 3)) 
		return 1;
	
	SDCommand(MASK_CMD7, rca, response);	
	return maxspeed;
}


S32 SDDrv_Initial(void)
{
	S32 	i, loopcnt=0;
	S32 	cardtype;
	U32 	response[4];
	
	U32 	tranunit, timevalue;
	U32 	maxspeed;
	U32		c_size, mult, blocklen;
	U32 	SpeedTable[]={
		0, 10, 12, 13, 15, 20, 25, 30, 35, 40, 45, 50, 55, 60, 70, 80,		
	};
	U32 	TranTable[]={
		1, 10, 100, 1000,
	};
	
	
	if(!gSDCardInsert)
		return 1;
	
	// Disable All SD Interrupt
	*P_SD_INT_CTRL = 0x0000;
	
	// Step 1, Reset SD Controller
	*P_SD_MODE_CTRL = MASK_C_BlockLen_512bytes|INIT_ClockSpeedFactor|MASK_C_ENSDBus|MASK_C_DMAMode;
	
	// Clear All Command
	*P_SD_COMMAND_SETUP = MASK_CMDSTOP;
	while (*P_SD_INT_STATUS & 0x1);
	
	// Clear All Status
	*P_SD_INT_STATUS = MASK_S_ClrAllBits;
	
	loopcnt = 0;
	
	// Step 2, Start 74 cycles on SD Clk Bus
	*P_SD_COMMAND_SETUP = MASK_ClockCycle74;
	
	if (WaitSDStatus(MASK_S_CmdComplete)) 
		return 1;

	*P_SD_INT_STATUS = MASK_S_ClrAllBits;

	// Step 3, Reset Command, Should be no response
	SDCommand(MASK_CMD0, 0x00000000, response);

	//////////////////////////////////////////////////////////////////
	//		SECTION 2.  CARD IDEN									//
	//////////////////////////////////////////////////////////////////

	loopcnt = 0;
	cardtype = SDCARD;

	// Step 4, Run ACMD 41 until card finish power up sequence
	do
	{
		if (cardtype == SDCARD) 
		{
			if (SDCommand(MASK_CMD55, 0x00000000, response)) 
				cardtype = MMCCARD;
		}
			
		if (cardtype == SDCARD) 
			// ACMD 41
			SDCommand(MASK_ACMD41, 0x00200000, response);	// SD Card
		else
			SDCommand(MASK_CMD1, 0x00200000, response);	// MMC Card
	
		// Check until Bit 31 in OCR register is set
		loopcnt = loopcnt + 1;
	} while (((response[0] & 0x80000000) == 0) && loopcnt < 2000);

	if (loopcnt == 20000) 
		return 1;

	// Step 5, CMD 2 Read CID Register
	if(SDCommandr2(MASK_CMD2, 0x00000000, response))
		return 1;
	
	if (cardtype == SDCARD)
	{
		// Step 6, CMD 3 Read New RCA, SD will generate RCA itself
		if(SDCommand(MASK_CMD3, 0x00000000, response))
			return 1;
		rca = response[0];
	} else {
		// Step 6, CMD 3 Set New RCA, MMC need to be assigned a new RCA
		if(SDCommand(MASK_CMD3, 0xFFFF0000, response))
			return 1;
		rca = 0xFFFF0000;
	}
	
	// Read Status
	SDCommand(MASK_CMD13, rca, response);

	if (response[0] != 0x0700) 
		return 1;

	//////////////////////////////////////////////////////////////////
	//		SECTION 3.  SET BUSWIDTH AND CLOCK SPEED				//
	//////////////////////////////////////////////////////////////////

	// Step 7, CMD 9 Read CSD Register
	for (i=0;i<4;i++) 
		response[i] = 0;
	if(SDCommandr2(MASK_CMD9, rca, response))
		return 1;
	
	// Calculate Totoal Memory Size
	blocklen = ((response[1] & 0x000F0000)>>16)-8;
	c_size = ((response[1] & 0x000003FF)<<2) + (response[2]>>30);
	mult = ((response[2] & 0x00030000)>>15) + ((response[2] & 0x0000FFFF)>>15);
	
	SDCardTotalSector = (blocklen*(c_size+1))<<(mult + 2);
	//
	
	
	timevalue 	= ((response[0] & 0x00000078)>>3);
	tranunit	= response[0] & 0x00000007;
	
	if((timevalue == 0) || (tranunit > 3))
		return 1;
	
	maxspeed 	= SpeedTable[timevalue] * TranTable[tranunit] / 100;
	
	if (maxspeed > 13)
		//Increase Clock Speed
		*P_SD_MODE_CTRL = MASK_C_BlockLen_512bytes|MIN_ClockSpeedFactor|MASK_C_ENSDBus|MASK_C_DMAMode;
	else 
		//Increase Clock Speed
		*P_SD_MODE_CTRL = MASK_C_BlockLen_512bytes|MMC_ClockSpeedFactor|MASK_C_ENSDBus|MASK_C_DMAMode;
	
	SDCommand(MASK_CMD13, rca, response);
	SDCommand(MASK_CMD7, rca, response);

	// Only SD has 4 bits mode
	if (cardtype == SDCARD)
	{
		//Short block size to 8 bytes
	    *P_SD_MODE_CTRL = MASK_C_BlockLen_8bytes|(*P_SD_MODE_CTRL&0xffff);
		
		//ACMD 51
		SDCommand(MASK_CMD55, rca, response);
		if(SDCommandr3(MASK_ACMD51, rca, response))
			return 1;
		
		if ((response[0] & 0x00000400) != 0x00)
		{
			//Set Bus width to 4 bits
			SDCommand(MASK_CMD55, rca, response);
			SDCommand(MASK_ACMD6, 0x00000002, response);
			*P_SD_MODE_CTRL = MASK_C_BlockLen_512bytes|MIN_ClockSpeedFactor|MASK_C_ENSDBus|MASK_C_DMAMode|MASK_C_BUSWIDTH_4;
		}
	
		else
			*P_SD_MODE_CTRL = MASK_C_BlockLen_512bytes|MIN_ClockSpeedFactor|MASK_C_ENSDBus|MASK_C_DMAMode;
	}

	SDCommand(MASK_CMD13, rca, response);

	*P_SD_MODE_CTRL = MASK_C_BlockLen_512bytes|(*P_SD_MODE_CTRL&0xffff);
	
	gSDCardPresent=1;		// SDCard Initial Success, set gSDCardPresent to 1
	
	return 0;
}