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		gSDCardPowerRecycleState;	// 0x00 : Card Power Off and set SD Pins as output low
									// 0x01 : Set CMD, CLK, D0~3 as input mode, and turn card power on
									// 0x02 : Set gSDCardInsert = 1

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);
void SDDrv_PowerOn(void);
void SDDrv_PowerOff(void);


S32		DrvSDCReadMulCommand(U32 block);
S32		DrvSDCReadMulData(U8 *outaddr);
S32		DrvSDCReadMulStop(void);
S32		DrvSDCWriteMulCommand(U32 block);
S32		DrvSDCWriteMulData(U8 *outaddr);
S32		DrvSDCWriteMulStop(void);
void	DrvSDCClockEn(void);
void	DrvSDCPowerRecycle(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;
}

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;
	

	if(SDCommand(MASK_CMD18,block<<9,response))
		return 1;	
	
	return 0;
}

S32		DrvSDCReadMulData(U8 *outaddr)
{
	U32	i;
	
	i=(U32) outaddr;
	
	if(CacheCurrType())
		DCacheFrcWrtInva();		// Force write-back entire D-Cache and set invalid
	else
		DCacheInvaEtr();		// Invalid Entire Data Cache
	
	
	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_CHANNEL0_CTRL = 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)
			if((gSDCardInsert == 0) || ((*P_SD_INT_STATUS & MASK_S_TimeOut) != 0))
			{
				// Clear Interrupt and Disable DMA channel
				*P_DMA_INT_STATUS = 0x1;
				*P_DMA_CHANNEL0_CTRL = 0x0000;	
				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);	
	}
	
	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		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(gSDCardWriteProtect)
		return 1;
	
	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_SD_ARGUMENT_DATA = block<<9;
//	*P_SD_COMMAND_SETUP = 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;
	}