enum sd_type {SD_NONE, SD_V1, SD_V2, MMC_V3};
enum {CSD_V1=0, CSD_V2=1};
enum {
    CMD0=0,CMD1=1,CMD2=2,CMD8=8,CMD9=9,CMD10=10,CMD13=13,CMD16=16,CMD17=17,
    CMD55=55,CMD58=58,CMD59=59,ACMD41=41
};
enum {
    R1_READY=0x00, R1_IDLE=0x01, R1_ERASE_RESET=0x02, R1_CMD_ILLEGAL=0x04,
    R1_CMD_CRC=0x08, R1_ERASE_SEQ=0x10, R1_ADDR=0x20, R1_PARAM=0x40
};
U8 sd_get_CSD(void) {
    sd_cs(0);
    sd_cmd_NoCRC(CMD9, 0x00000000, 0x57);
    sd.r1 = (sd_get_R1() == R1_READY);
    if (sd.r1) {
        sd.r1 = sd_get_buf(&sd.csd[0], 16, 0xFE);
        sd_update_csd();
    }
    return sd.r1;
}
void sd_cmd_NoCRC(U8 cmd, U32 data, U8 crc) {
    spi_tx_U8_MSB(0xFF);
    spi_tx_U8_MSB(0x40 | cmd);
    spi_tx_U8_MSB(data >> 24);
    spi_tx_U8_MSB(data >> 16);
    spi_tx_U8_MSB(data >> 8);
    spi_tx_U8_MSB(data);
    spi_tx_U8_MSB((crc << 1) | 1);
}
U8 sd_get_R1(void) {
    U8 r1 = 0;
    U16 to = SD_CMD_TIMEOUT;
    do { r1 = spi_tx_U8_MSB(0xFF);
    } while (--to && (r1 == 0xFF));
    sd.r1 = r1;
    return r1;
}
U8 sd_get_buf(U8 *buf, U16 len, U8 token) {
    U8 r1 = 0;
    U16 to = SD_CMD_TIMEOUT;
    do {
        r1 = (spi_tx_U8_MSB(0xFF) == token);
    } while (--to && !r1);
    if (r1) {
        spi_rx_buf_MSB(buf, len);

        //skip CRC
        spi_tx_U8_MSB(0xFF);
        spi_tx_U8_MSB(0xFF);
    }
    return r1;
}
void sd_update_csd(void) {
    sd.sectors = 0;
    if (sd_ok()) {
        sd.ver = sd.csd[0] >> 6;
        if (sd.ver == CSD_V1) {
            U32 size = 1UL << (sd.csd[5] & 0xF);
            size *= 1UL << (((sd.csd[9] & 0x3) << 1) + (sd.csd[10] >> 7) + 2);
            size *= (U32)((((U16)(sd.csd[6] & 3)) << 10) + ((U16)sd.csd[7] << 2) + ((U16)(sd.csd[8] & 0xC0) >> 6) + 1);
            sd.sectors = size >> 9;
        } else if (sd.ver == CSD_V2) {
            sd.sectors = ((((U32)(sd.csd[7] & 0x3F)) << 16) + (((U32)sd.csd[8]) << 8) + (U32)sd.csd[9]) << 10;
        }
    }
}

void SDCard::SendCmd(SDCardCmd *command)
{
unsigned char *byte = (unsigned char *)command;

// Send 6 bytes of command
for(int i = 0; i < 6; i++)
{
McBSPA_WriteByte(byte[i]);
}

// Send 1 byte of pause
//McBSPA_WriteByte(0xFF);
}

void SDCard::RecvRsp(unsigned char *response, unsigned short len)
{
McbspaRegs.SPCR1.bit.RRST = 1;

// wait for 1-st byte of response
do
{
McBSPA_WriteByte(0xFF);
response[0] = McBSPA_ReadByte();
}
while(response[0] == 0xFF);

// receive len-1 bytes of response
for(int i = 1; i < len; i++)
{
McBSPA_WriteByte(0xFF);
response[i] = McBSPA_ReadByte();
}

McbspaRegs.SPCR1.bit.RRST = 0;

// Send 1 byte of pause
McBSPA_WriteByte(0xFF);
}