mirror of
https://github.com/ApacheThunder/SCKILL.git
synced 2025-06-18 11:05:50 -04:00
249 lines
7.3 KiB
C
249 lines
7.3 KiB
C
/*
|
||
io_sd_common.c
|
||
|
||
By chishm (Michael Chisholm)
|
||
|
||
Common SD card routines
|
||
|
||
SD routines partially based on sd.s by Romman
|
||
|
||
Copyright (c) 2006 Michael "Chishm" Chisholm
|
||
|
||
Redistribution and use in source and binary forms, with or without modification,
|
||
are permitted provided that the following conditions are met:
|
||
|
||
1. Redistributions of source code must retain the above copyright notice,
|
||
this list of conditions and the following disclaimer.
|
||
2. Redistributions in binary form must reproduce the above copyright notice,
|
||
this list of conditions and the following disclaimer in the documentation and/or
|
||
other materials provided with the distribution.
|
||
3. The name of the author may not be used to endorse or promote products derived
|
||
from this software without specific prior written permission.
|
||
|
||
THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
|
||
WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY
|
||
AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE
|
||
LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
|
||
DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
|
||
LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
||
THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||
(INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
|
||
EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||
*/
|
||
|
||
#include "my_io_sd_common.h"
|
||
|
||
#include <gba_console.h>
|
||
#define MAX_STARTUP_TRIES 1000 // Arbitrary value, check if the card is ready 20 times before giving up
|
||
#define RESPONSE_TIMEOUT 256 // Number of clocks sent to the SD card before giving up
|
||
|
||
#define iprintf(...)
|
||
|
||
/*
|
||
Improved CRC7 function provided by cory1492
|
||
Calculates the CRC of an SD command, and includes the end bit in the byte
|
||
*/
|
||
u8 _SD_CRC7_my(u8* data, int cnt) {
|
||
int i, a;
|
||
u8 crc, temp;
|
||
|
||
crc = 0;
|
||
for (a = 0; a < cnt; a++)
|
||
{
|
||
temp = data[a];
|
||
for (i = 0; i < 8; i++)
|
||
{
|
||
crc <<= 1;
|
||
if ((temp & 0x80) ^ (crc & 0x80)) crc ^= 0x09;
|
||
temp <<= 1;
|
||
}
|
||
}
|
||
crc = (crc << 1) | 1;
|
||
return(crc);
|
||
}
|
||
|
||
/*
|
||
Calculates the CRC16 for a sector of data. Calculates it
|
||
as 4 separate lots, merged into one buffer. This is used
|
||
for 4 SD data lines, not for 1 data line alone.
|
||
*/
|
||
void _SD_CRC16_my (u8* buff, int buffLength, u8* crc16buff) {
|
||
u32 a, b, c, d;
|
||
int count;
|
||
u32 bitPattern = 0x80808080; // r7
|
||
u32 crcConst = 0x1021; // r8
|
||
u32 dataByte = 0; // r2
|
||
|
||
a = 0; // r3
|
||
b = 0; // r4
|
||
c = 0; // r5
|
||
d = 0; // r6
|
||
|
||
buffLength = buffLength * 8;
|
||
|
||
|
||
do {
|
||
if (bitPattern & 0x80) dataByte = *buff++;
|
||
|
||
a = a << 1;
|
||
if ( a & 0x10000) a ^= crcConst;
|
||
if (dataByte & (bitPattern >> 24)) a ^= crcConst;
|
||
|
||
b = b << 1;
|
||
if (b & 0x10000) b ^= crcConst;
|
||
if (dataByte & (bitPattern >> 25)) b ^= crcConst;
|
||
|
||
c = c << 1;
|
||
if (c & 0x10000) c ^= crcConst;
|
||
if (dataByte & (bitPattern >> 26)) c ^= crcConst;
|
||
|
||
d = d << 1;
|
||
if (d & 0x10000) d ^= crcConst;
|
||
if (dataByte & (bitPattern >> 27)) d ^= crcConst;
|
||
|
||
bitPattern = (bitPattern >> 4) | (bitPattern << 28);
|
||
} while (buffLength-=4);
|
||
|
||
count = 16; // r8
|
||
|
||
do {
|
||
bitPattern = bitPattern << 4;
|
||
if (a & 0x8000) bitPattern |= 8;
|
||
if (b & 0x8000) bitPattern |= 4;
|
||
if (c & 0x8000) bitPattern |= 2;
|
||
if (d & 0x8000) bitPattern |= 1;
|
||
|
||
a = a << 1;
|
||
b = b << 1;
|
||
c = c << 1;
|
||
d = d << 1;
|
||
|
||
count--;
|
||
|
||
if (!(count & 0x01)) {
|
||
*crc16buff++ = (u8)(bitPattern & 0xff);
|
||
}
|
||
} while (count != 0);
|
||
|
||
return;
|
||
}
|
||
|
||
/*
|
||
Initialise the SD card, after it has been sent into an Idle state
|
||
cmd_6byte_response: a pointer to a function that sends the SD card a command and gets a 6 byte response
|
||
cmd_17byte_response: a pointer to a function that sends the SD card a command and gets a 17 byte response
|
||
use4bitBus: initialise card to use a 4 bit data bus when communicating with the card
|
||
RCA: a pointer to the location to store the card's Relative Card Address, preshifted up by 16 bits.
|
||
*/
|
||
|
||
#define CMD8 8
|
||
#define CMD58 58
|
||
#define R1_ILLEGAL_COMMAND 0x04
|
||
bool _SD_InitCard_SDHC (_SD_FN_CMD_6BYTE_RESPONSE cmd_6byte_response,
|
||
_SD_FN_CMD_17BYTE_RESPONSE cmd_17byte_response,
|
||
bool use4bitBus,
|
||
u32 *RCA,bool *isSDHC)
|
||
{
|
||
u8 responseBuffer[17] = {0};
|
||
int i;
|
||
|
||
*isSDHC = false;
|
||
|
||
bool cmd8Response = cmd_17byte_response(responseBuffer, CMD8, 0x1AA);//0xa 是确定的 0xAA是推荐值
|
||
|
||
|
||
iprintf("\n");
|
||
//CMD8 也就是 Send Interface Condition Command
|
||
//正确的回显是：CMD8，Ver=0,Reserved=0,EchoBack=1,EchoBack=0XAA
|
||
if (cmd8Response && responseBuffer[0] == CMD8 && responseBuffer[1] == 0 && responseBuffer[2] == 0 && responseBuffer[3] == 0x1 && responseBuffer[4] == 0xAA) {
|
||
*isSDHC = true;
|
||
iprintf("CMD8 Return OK,might be a SDHC\n");
|
||
}else{
|
||
iprintf("CMD8 ERR not SDHC\n");
|
||
iprintf("resp:");
|
||
for(int i=0;i<17;i++){
|
||
iprintf("[%d]=%X ",i,responseBuffer[i]);
|
||
}
|
||
}
|
||
for (i = 0; i < MAX_STARTUP_TRIES; i++) {
|
||
cmd_6byte_response(responseBuffer, APP_CMD, 0);//CMD55
|
||
if (responseBuffer[0] != APP_CMD) {
|
||
iprintf("Failed to send APP_CMD\n"); //进入到APP模式，可以执行ACMD41
|
||
return false;
|
||
}
|
||
|
||
u32 arg = SD_OCR_VALUE;
|
||
if (*isSDHC) {
|
||
arg |= (1<<30); // Set HCS bit,Supports SDHC
|
||
arg |= (1<<28); //Max performance
|
||
}
|
||
|
||
if (cmd_6byte_response(responseBuffer, SD_APP_OP_COND, arg) &&//ACMD41
|
||
((responseBuffer[1] & (1<<7)) != 0)/*Busy:0b:initing 1b:init completed*/) {
|
||
iprintf("ACMD41 accepted init completed\n");
|
||
break; // Card is ready
|
||
}
|
||
}
|
||
|
||
if (i >= MAX_STARTUP_TRIES) {
|
||
return false;
|
||
}
|
||
if (isSDHC) {
|
||
cmd_6byte_response(responseBuffer, CMD58, 0);
|
||
iprintf("CMD58 response received\n");
|
||
// u32 ocr = (responseBuffer[1] << 24) | (responseBuffer[2] << 16) |
|
||
// (responseBuffer[3] << 8) | responseBuffer[4];
|
||
if ((responseBuffer[1] & (1<<6)) == 0) {//Card Capacity Status (CCS)
|
||
iprintf("CMD58 OCR ERROR!! Not SDHC\n\n");
|
||
*isSDHC = false;
|
||
}else{
|
||
iprintf("OCR OK! Is SDHC\n");
|
||
}
|
||
// Further processing of OCR can be done here if needed
|
||
}
|
||
|
||
// The card's name, as assigned by the manufacturer
|
||
cmd_17byte_response (responseBuffer, ALL_SEND_CID, 0);
|
||
|
||
// Get a new address
|
||
for (i = 0; i < MAX_STARTUP_TRIES ; i++) {
|
||
cmd_6byte_response (responseBuffer, SEND_RELATIVE_ADDR, 0);
|
||
*RCA = (responseBuffer[1] << 24) | (responseBuffer[2] << 16);
|
||
if ((responseBuffer[3] & 0x1e) != (SD_STATE_STBY << 1)) {
|
||
iprintf("RCA set\n");
|
||
break;
|
||
}
|
||
}
|
||
if (i >= MAX_STARTUP_TRIES) {
|
||
return false;
|
||
}
|
||
|
||
// Some cards won't go to higher speeds unless they think you checked their capabilities
|
||
cmd_17byte_response (responseBuffer, SEND_CSD, *RCA);
|
||
|
||
// Only this card should respond to all future commands
|
||
cmd_6byte_response (responseBuffer, SELECT_CARD, *RCA);
|
||
|
||
if (use4bitBus) {
|
||
// Set a 4 bit data bus
|
||
cmd_6byte_response (responseBuffer, APP_CMD, *RCA);
|
||
cmd_6byte_response (responseBuffer, SET_BUS_WIDTH, 2); // 4-bit mode.
|
||
}
|
||
|
||
// Use 512 byte blocks
|
||
cmd_6byte_response (responseBuffer, SET_BLOCKLEN, 512); // 512 byte blocks
|
||
|
||
// Wait until card is ready for data
|
||
i = 0;
|
||
do {
|
||
if (i >= RESPONSE_TIMEOUT) {
|
||
return false;
|
||
}
|
||
i++;
|
||
} while (!cmd_6byte_response (responseBuffer, SEND_STATUS, *RCA) && ((responseBuffer[3] & 0x1f) != ((SD_STATE_TRAN << 1) | READY_FOR_DATA)));
|
||
|
||
return true;
|
||
}
|
||
|
||
|