SD卡 读取 CSD 容量读取问题解决 (2)

工程代码：  2_spi_sd卡读写扇区csd容量问题.rar  
看资料 ： sd卡文件 http://blog.chinaunix.net/space.php?uid=22666248&do=blog&id=1593835
          csd 寄存器 http://www.baiheee.com/Documents/091203/091203224635.htm     

        2G SD卡  获取的容量大小
                  高16位 ：29
                  低16位： 18432
              所以容量大小：29 * 2^16 + 18432 字节

/*******************************************************************************
* Function Name  : SD_GetCapacity
* Description    : 获取SD卡的容量
* Input          : None
* Output         : None
* Return         : u32 capacity
*                   0： 取容量出错
*******************************************************************************/
u32 SD_GetCapacity(void)
{
    u8 csd[16];
    u32 Capacity ;
    u8 r1 ;
    u16 i ;
    u16 temp ;

    //取CSD信息，如果期间出错，返回0
    if(SD_GetCSD(csd)!=22)
    {
        return 33 ;
    }

    //如果为SDHC卡，按照下面方式计算
    if((csd[0]&0xC0)==0x40)
    {
        Capacity=(((u32)csd[8])<<8+(u32)csd[9]+1)*(u32)1024 ;
    }
    else
    {
        //下面代码为网上版本
        ////////////formula of the capacity///////////////
        //
        //  memory capacity = BLOCKNR * BLOCK_LEN
        //
        //    BLOCKNR = (C_SIZE + 1)* MULT
        //
        //           C_SIZE_MULT+2
        //    MULT = 2
        //
        //               READ_BL_LEN
        //    BLOCK_LEN = 2
        /**********************************************/
        //C_SIZE
        #if 0
        /*下面的程序代码，计算容量，在自己的SD卡上没有用*/
        i=csd[6]&0x03 ;
        i<<=8 ;
        i+=csd[7];
        i<<=2 ;
        i+=((csd[8]&0xc0)>>6);

        //C_SIZE_MULT
        r1=csd[9]&0x03 ;
        r1<<=1 ;
        r1+=((csd[10]&0x80)>>7);

        //BLOCKNR
        r1+=2 ;
        temp=1 ;
        while(r1)
        {
            temp*=2 ;
            r1--;
        }
        Capacity=((u32)(i+1))*((u32)temp);

        // READ_BL_LEN
        i=csd[5]&0x0f ;
        //BLOCK_LEN
        temp=1 ;
        while(i)
        {
            temp*=2 ;
            i--;
        }
        //The final result
        Capacity*=(u32)temp ;
        //Capacity /= 512;
        #endif

        //使用这个计算方式 计算 容量
        Capacity = (((csd[6]&0x03)<<10) | (csd[7]<<2) | ((csd[8]&0xC0)>>6) + 1) * (1 << ((((csd[9]&0x03)<<1) | ((csd[10]&0x80)>>7)) + 2));
    }
    return (u32)Capacity ;
}