#include "SD.h"
#include <spi.h> 
#include <delay.h>
void SPI_Init()
{
    DDRB.4=1;  //SS
    DDRB.5=1;  //MOSI
    DDRB.6=0;  //MISO
    DDRB.7=1;  //SCK 
    
    SD_CS=1;
    // SPI initialization
    // SPI Type: Master
    // SPI Clock Rate: 115.200 kHz
    // SPI Clock Phase: Cycle Half
    // SPI Clock Polarity: Low
    // SPI Data Order: MSB First
    SPCR=0x52;
    SPSR=0x00;
} 
//****************************************************************************
//Send a Command to MMC/SD-Card
//Return: the second byte of response register of MMC/SD-Card
//****************************************************************************
unsigned char SD_Write_Command(unsigned char *cmd)
{
    unsigned char i=0,k=0;
	  unsigned char temp=0XFF;
    SD_CS=1;		   			/* 片選無效 */
  	spi(0XFF);				/* 發送8個時鐘 */
  	SD_CS=0;		   			/* 片選有效 */

  	for(i=0; i<6; i++)
  	{
  	    spi(*(cmd++));		/* 發送命令 */   
  	}
  	while(temp==0XFF)
  	{
  	    temp = spi(0XFF);  /* 等待回復 */
  		  if(k++>200)             /* 超時返回 */
  		  {
  		      return temp;
  		  }
    }
    return temp;
}
//****************************************************************************
//SD卡初始化(SPI-MODE)
//****************************************************************************
unsigned char SD_Init(void)
{ 
    unsigned int timeout;
	  unsigned char i=0;
    unsigned char cmd[]={0x40,0x00,0x00,0x00,0x00,0x95};  
	  delay_ms(500);
	/* 發送一定數量的時鐘脈沖 */
    for(i=0;i<0x10;i++) 
    {
        spi(0XFF);
    }
	/* 發送CMD0 */
	  if(SD_Write_Command(cmd)!=0X01)
	      return 0;
	/* 發送CMD1 */
	  cmd[0]=0X41;
	  cmd[5]=0XFF;
	  while(SD_Write_Command(cmd)!=0X00)
	  {
	      if(timeout++>0XFFFE)     /* 等待初始化完成 */
            return 0;            /* 容量大的MMC卡需要用比較長時間 */
	  }
	  SPSR=0x01;   				 /*  提高MCU SPI速度 */
    return 1;
} 
//****************************************************************************
//從SD卡讀一個扇區 
//long address --SD卡地址
//*P--存儲緩沖
//Return 0 if no Error.
//****************************************************************************
unsigned char SD_Read_Block(unsigned long address,unsigned char *pbuf)
{ 
    unsigned int i;

    unsigned char cmd[]={0x40,0x00,0x00,0x00,0x00,0xff};  
    cmd[0]=0X40+17;			 /* READ SINGLE BLOCK */
	  address=address<<9;         /* address*512,取512的整數倍 */
	  cmd[1]=(address>>24);
	  cmd[2]=(address>>16);
	  cmd[3]=(address>>8);
	  cmd[4]=(address>>0);
	  if(SD_Write_Command(cmd)!=0X00)     /* 發送CMD17 */
	      return 0;               /* 讀取失敗 */
    while(spi(0XFF)!=0XFE)
	  {
	     #asm("nop");			 /* 等待數據接受開始，受到0XFE表示開始 */
	  }
	  for(i=0;i<512;i++)          /* 讀取數據 */
	  {
	     pbuf[i]=spi(0XFF);
	  }
	 spi(0XFF);			 /* 取走CRC字節 */
	 spi(0XFF);
	 return 1; 
}
//***************************************************************************
//SD卡寫一個扇區 
//long address --SD卡地址
//*P--存儲緩沖
// Return 0 if no Error.
//***************************************************************************
unsigned char SD_Write_Block(unsigned long address,unsigned char *pbuf)
{
    unsigned int i;
    unsigned char temp;
    unsigned char cmd[]={0x40,0x00,0x00,0x00,0x00,0xff};  
	  cmd[0]=0x40+24;              /* WRITE SINGLE BLOCK */
	  address=address<<9;          /* address*512,取512的整數倍 */
	  cmd[1]=(address>>24);
	  cmd[2]=(address>>16);
	  cmd[3]=(address>>8);
	  cmd[4]=(address>>0);
	  if(SD_Write_Command(cmd)!=0X00)     /* 發送CMD24 */
	      return 0;               /* 寫入失敗 */
	  spi(0XFF);             /* 發送填沖字節 */
	  spi(0XFE);             /* 發送數據開始標志0XFE */
	  for(i=0;i<512;i++)          /* 寫入數據 */
	  {
	     spi(pbuf[i]);
	  }
	  spi(0XFF);			 /* 寫入CRC字節 */
	  spi(0XFF);
	  temp=spi(0XFF);		 /* 讀取XXX0 0101字節 */
	  temp=temp&0X1F;
	  if(temp!=0X05)
	      return 0; 				 /* 寫入失敗 */
	  while(spi(0XFF)==0X00)
	  {
	     #asm("nop");			 /* BUSY等待 */
	  }
	  return 1;
}