Nyaaori/rockbox
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity
rockbox/firmware/target/arm/sandisk/sansa-e200/ata-e200.c
Michael Sevakis 00251d1643 e200: This should stop lockups on sansa with struck SD card insert detection. Hopefully no new troubles will rear up. 
git-svn-id: svn://svn.rockbox.org/rockbox/trunk@13862 a1c6a512-1295-4272-9138-f99709370657
2007-07-12 06:50:42 +00:00

976 lines
30 KiB
C
Raw Blame History

/***************************************************************************
* __________ __ ___.
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
* \/ \/ \/ \/ \/
* $Id$
*
* Copyright (C) 2006 Daniel Ankers
*
* All files in this archive are subject to the GNU General Public License.
* See the file COPYING in the source tree root for full license agreement.
*
* This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
* KIND, either express or implied.
*
****************************************************************************/
#include "ata.h"
#include "hotswap-target.h"
#include "ata-target.h"
#include "ata_idle_notify.h"
#include "system.h"
#include <string.h>
#include "thread.h"
#include "led.h"
#include "disk.h"
#include "pp5024.h"
#include "panic.h"
#define BLOCK_SIZE (512)
#define SECTOR_SIZE (512)
#define BLOCKS_PER_BANK 0x7a7800
#define STATUS_REG (*(volatile unsigned int *)(0x70008204))
#define REG_1 (*(volatile unsigned int *)(0x70008208))
#define UNKNOWN (*(volatile unsigned int *)(0x70008210))
#define BLOCK_SIZE_REG (*(volatile unsigned int *)(0x7000821c))
#define BLOCK_COUNT_REG (*(volatile unsigned int *)(0x70008220))
#define REG_5 (*(volatile unsigned int *)(0x70008224))
#define CMD_REG0 (*(volatile unsigned int *)(0x70008228))
#define CMD_REG1 (*(volatile unsigned int *)(0x7000822c))
#define CMD_REG2 (*(volatile unsigned int *)(0x70008230))
#define RESPONSE_REG (*(volatile unsigned int *)(0x70008234))
#define SD_STATE_REG (*(volatile unsigned int *)(0x70008238))
#define REG_11 (*(volatile unsigned int *)(0x70008240))
#define REG_12 (*(volatile unsigned int *)(0x70008244))
#define DATA_REG (*(volatile unsigned int *)(0x70008280))
/* STATUS_REG bits */
#define DATA_DONE (1 << 12)
#define CMD_DONE (1 << 13)
#define ERROR_BITS (0x3f)
#define READY_FOR_DATA (1 << 8)
#define FIFO_FULL (1 << 7)
#define FIFO_EMPTY (1 << 6)
#define CMD_OK 0x0 /* Command was successful */
#define CMD_ERROR_2 0x2 /* Seen when SD card is not inserted */
/* SD States */
#define IDLE 0
#define READY 1
#define IDENT 2
#define STBY 3
#define TRAN 4
#define DATA 5
#define RCV 6
#define PRG 7
#define DIS 8
#define FIFO_SIZE 16 /* FIFO is 16 words deep */
/* SD Commands */
#define GO_IDLE_STATE 0
#define ALL_SEND_CID 2
#define SEND_RELATIVE_ADDR 3
#define SET_DSR 4
#define SWITCH_FUNC 6
#define SELECT_CARD 7
#define DESELECT_CARD 7
#define SEND_CSD 9
#define SEND_CID 10
#define STOP_TRANSMISSION 12
#define SEND_STATUS 13
#define GO_INACTIVE_STATE 15
#define SET_BLOCKLEN 16
#define READ_SINGLE_BLOCK 17
#define READ_MULTIPLE_BLOCK 18
#define SEND_NUM_WR_BLOCKS 22
#define WRITE_BLOCK 24
#define WRITE_MULTIPLE_BLOCK 25
#define ERASE_WR_BLK_START 32
#define ERASE_WR_BLK_END 33
#define ERASE 38
#define APP_CMD 55
#define EC_POWER_UP 1 /* error code */
#define EC_READ_TIMEOUT 2 /* error code */
#define EC_WRITE_TIMEOUT 3 /* error code */
#define EC_TRAN_SEL_BANK 4 /* error code */
#define EC_TRAN_READ_ENTRY 5 /* error code */
#define EC_TRAN_READ_EXIT 6 /* error code */
#define EC_TRAN_WRITE_ENTRY 7 /* error code */
#define EC_TRAN_WRITE_EXIT 8 /* error code */
#define DO_PANIC 32 /* marker */
#define NO_PANIC 0 /* marker */
#define EC_COMMAND 10 /* error code */
#define EC_FIFO_SEL_BANK_EMPTY 11 /* error code */
#define EC_FIFO_SEL_BANK_DONE 12 /* error code */
#define EC_FIFO_ENA_BANK_EMPTY 13 /* error code */
#define EC_FIFO_READ_FULL 14 /* error code */
#define EC_FIFO_WR_EMPTY 15 /* error code */
#define EC_FIFO_WR_DONE 16 /* error code */
/* Application Specific commands */
#define SET_BUS_WIDTH 6
#define SD_APP_OP_COND 41
/* for compatibility */
int ata_spinup_time = 0;
long last_disk_activity = -1;
static bool initialized = false;
static int sd1_status = 0x00; /* 0x00:inserted, 0x80:not inserted */
static tSDCardInfo card_info[2];
static tSDCardInfo *currcard; /* current active card */
/* Shoot for around 75% usage */
static long sd_stack [(DEFAULT_STACK_SIZE*2 + 0x1c0)/sizeof(long)];
static const char sd_thread_name[] = "ata/sd";
static struct mutex sd_mtx;
static struct event_queue sd_queue;
/* Posted when card plugged status has changed */
#define SD_HOTSWAP 1
/* Private Functions */
static unsigned int check_time[10];
static inline void sd_check_timeout(unsigned int timeout, int id)
{
if (USEC_TIMER > check_time[id] + timeout)
panicf("Error SDCard: %d", id);
}
static inline bool sd_poll_status(unsigned int trigger, unsigned int timeout,
int id)
{
unsigned int t = USEC_TIMER;
while ((STATUS_REG & trigger) == 0)
{
if (USEC_TIMER > t + timeout)
{
if(id & DO_PANIC)
panicf("Error SDCard: %d", id & 31);
return false;
}
}
return true;
}
static bool sd_command(unsigned int cmd, unsigned long arg1,
unsigned int *response, unsigned int type)
{
int i, words; /* Number of 16 bit words to read from RESPONSE_REG */
unsigned int data[9];
CMD_REG0 = cmd;
CMD_REG1 = (unsigned int)((arg1 & 0xffff0000) >> 16);
CMD_REG2 = (unsigned int)((arg1 & 0xffff));
UNKNOWN = type;
sd_poll_status(CMD_DONE, 100000, EC_COMMAND | DO_PANIC);
if ((STATUS_REG & ERROR_BITS) != CMD_OK)
return false; /* Error sending command */
if (cmd == GO_IDLE_STATE)
return true; /* no response here */
words = (type == 2) ? 9 : 3;
for (i = 0; i < words; i++) /* RESPONSE_REG is read MSB first */
{
data[i] = RESPONSE_REG; /* Read most significant 16-bit word */
}
if (type == 2)
{
/* Response type 2 has the following structure:
* [135:135] Start Bit - '0'
* [134:134] Transmission bit - '0'
* [133:128] Reserved - '111111'
* [127:001] CID or CSD register including internal CRC7
* [000:000] End Bit - '1'
*/
response[3] = (data[0]<<24) + (data[1]<<8) + ((data[2]&0xff00)>>8);
response[2] = (data[2]<<24) + (data[3]<<8) + ((data[4]&0xff00)>>8);
response[1] = (data[4]<<24) + (data[5]<<8) + ((data[6]&0xff00)>>8);
response[0] = (data[6]<<24) + (data[7]<<8) + ((data[8]&0xff00)>>8);
}
else
{
/* Response types 1, 1b, 3, 6 have the following structure:
* Types 4 and 5 are not supported.
*
* [47] Start bit - '0'
* [46] Transmission bit - '0'
* [45:40] R1, R1b, R6: Command index
* R3: Reserved - '111111'
* [39:8] R1, R1b: Card Status
* R3: OCR Register
* R6: [31:16] RCA
* [15: 0] Card Status Bits 23, 22, 19, 12:0
* [23] COM_CRC_ERROR
* [22] ILLEGAL_COMMAND
* [19] ERROR
* [12:9] CURRENT_STATE
* [8] READY_FOR_DATA
* [7:6]
* [5] APP_CMD
* [4]
* [3] AKE_SEQ_ERROR
* [2] Reserved
* [1:0] Reserved for test mode
* [7:1] R1, R1b: CRC7
* R3: Reserved - '1111111'
* [0] End Bit - '1'
*/
response[0] = (data[0]<<24) + (data[1]<<8) + ((data[2]&0xff00)>>8);
}
return true;
}
static void sd_wait_for_state(unsigned int state, unsigned int id)
{
unsigned int response = 0;
check_time[id] = USEC_TIMER;
while (1)
{
sd_command(SEND_STATUS, currcard->rca, &response, 1);
sd_check_timeout(0x80000, id);
if (((response >> 9) & 0xf) == state)
break;
priority_yield();
}
SD_STATE_REG = state;
}
static inline void copy_read_sectors_fast(unsigned char **buf)
{
/* Copy one chunk of 16 words using best method for start alignment */
switch ( (intptr_t)*buf & 3 )
{
case 0:
asm volatile (
"ldmia %[data], { r2-r9 } \r\n"
"orr r2, r2, r3, lsl #16 \r\n"
"orr r4, r4, r5, lsl #16 \r\n"
"orr r6, r6, r7, lsl #16 \r\n"
"orr r8, r8, r9, lsl #16 \r\n"
"stmia %[buf]!, { r2, r4, r6, r8 } \r\n"
"ldmia %[data], { r2-r9 } \r\n"
"orr r2, r2, r3, lsl #16 \r\n"
"orr r4, r4, r5, lsl #16 \r\n"
"orr r6, r6, r7, lsl #16 \r\n"
"orr r8, r8, r9, lsl #16 \r\n"
"stmia %[buf]!, { r2, r4, r6, r8 } \r\n"
: [buf]"+&r"(*buf)
: [data]"r"(&DATA_REG)
: "r2", "r3", "r4", "r5", "r6", "r7", "r8", "r9"
);
break;
case 1:
asm volatile (
"ldmia %[data], { r2-r9 } \r\n"
"orr r3, r2, r3, lsl #16 \r\n"
"strb r3, [%[buf]], #1 \r\n"
"mov r3, r3, lsr #8 \r\n"
"strh r3, [%[buf]], #2 \r\n"
"mov r3, r3, lsr #16 \r\n"
"orr r3, r3, r4, lsl #8 \r\n"
"orr r3, r3, r5, lsl #24 \r\n"
"mov r5, r5, lsr #8 \r\n"
"orr r5, r5, r6, lsl #8 \r\n"
"orr r5, r5, r7, lsl #24 \r\n"
"mov r7, r7, lsr #8 \r\n"
"orr r7, r7, r8, lsl #8 \r\n"
"orr r7, r7, r9, lsl #24 \r\n"
"mov r2, r9, lsr #8 \r\n"
"stmia %[buf]!, { r3, r5, r7 } \r\n"
"ldmia %[data], { r3-r10 } \r\n"
"orr r2, r2, r3, lsl #8 \r\n"
"orr r2, r2, r4, lsl #24 \r\n"
"mov r4, r4, lsr #8 \r\n"
"orr r4, r4, r5, lsl #8 \r\n"
"orr r4, r4, r6, lsl #24 \r\n"
"mov r6, r6, lsr #8 \r\n"
"orr r6, r6, r7, lsl #8 \r\n"
"orr r6, r6, r8, lsl #24 \r\n"
"mov r8, r8, lsr #8 \r\n"
"orr r8, r8, r9, lsl #8 \r\n"
"orr r8, r8, r10, lsl #24 \r\n"
"mov r10, r10, lsr #8 \r\n"
"stmia %[buf]!, { r2, r4, r6, r8 } \r\n"
"strb r10, [%[buf]], #1 \r\n"
: [buf]"+&r"(*buf)
: [data]"r"(&DATA_REG)
: "r2", "r3", "r4", "r5", "r6", "r7", "r8", "r9", "r10"
);
break;
case 2:
asm volatile (
"ldmia %[data], { r2-r9 } \r\n"
"strh r2, [%[buf]], #2 \r\n"
"orr r3, r3, r4, lsl #16 \r\n"
"orr r5, r5, r6, lsl #16 \r\n"
"orr r7, r7, r8, lsl #16 \r\n"
"stmia %[buf]!, { r3, r5, r7 } \r\n"
"ldmia %[data], { r2-r8, r10 } \r\n"
"orr r2, r9, r2, lsl #16 \r\n"
"orr r3, r3, r4, lsl #16 \r\n"
"orr r5, r5, r6, lsl #16 \r\n"
"orr r7, r7, r8, lsl #16 \r\n"
"stmia %[buf]!, { r2, r3, r5, r7 } \r\n"
"strh r10, [%[buf]], #2 \r\n"
: [buf]"+&r"(*buf)
: [data]"r"(&DATA_REG)
: "r2", "r3", "r4", "r5", "r6", "r7", "r8", "r9", "r10"
);
break;
case 3:
asm volatile (
"ldmia %[data], { r2-r9 } \r\n"
"orr r3, r2, r3, lsl #16 \r\n"
"strb r3, [%[buf]], #1 \r\n"
"mov r3, r3, lsr #8 \r\n"
"orr r3, r3, r4, lsl #24 \r\n"
"mov r4, r4, lsr #8 \r\n"
"orr r5, r4, r5, lsl #8 \r\n"
"orr r5, r5, r6, lsl #24 \r\n"
"mov r6, r6, lsr #8 \r\n"
"orr r7, r6, r7, lsl #8 \r\n"
"orr r7, r7, r8, lsl #24 \r\n"
"mov r8, r8, lsr #8 \r\n"
"orr r2, r8, r9, lsl #8 \r\n"
"stmia %[buf]!, { r3, r5, r7 } \r\n"
"ldmia %[data], { r3-r10 } \r\n"
"orr r2, r2, r3, lsl #24 \r\n"
"mov r3, r3, lsr #8 \r\n"
"orr r4, r3, r4, lsl #8 \r\n"
"orr r4, r4, r5, lsl #24 \r\n"
"mov r5, r5, lsr #8 \r\n"
"orr r6, r5, r6, lsl #8 \r\n"
"orr r6, r6, r7, lsl #24 \r\n"
"mov r7, r7, lsr #8 \r\n"
"orr r8, r7, r8, lsl #8 \r\n"
"orr r8, r8, r9, lsl #24 \r\n"
"mov r9, r9, lsr #8 \r\n"
"orr r10, r9, r10, lsl #8 \r\n"
"stmia %[buf]!, { r2, r4, r6, r8 } \r\n"
"strh r10, [%[buf]], #2 \r\n"
"mov r10, r10, lsr #16 \r\n"
"strb r10, [%[buf]], #1 \r\n"
: [buf]"+&r"(*buf)
: [data]"r"(&DATA_REG)
: "r2", "r3", "r4", "r5", "r6", "r7", "r8", "r9", "r10"
);
break;
}
}
static inline void copy_read_sectors_slow(unsigned char** buf)
{
int cnt = FIFO_SIZE;
int t;
/* Copy one chunk of 16 words */
asm volatile (
"1: \r\n"
"ldrh %[t], [%[data]] \r\n"
"strb %[t], [%[buf]], #1 \r\n"
"mov %[t], %[t], lsr #8 \r\n"
"strb %[t], [%[buf]], #1 \r\n"
"subs %[cnt], %[cnt], #1 \r\n"
"bgt 1b \r\n"
: [cnt]"+&r"(cnt), [buf]"+&r"(*buf),
[t]"=&r"(t)
: [data]"r"(&DATA_REG)
);
}
/* Writes have to be kept slow for now */
static inline void copy_write_sectors(const unsigned char* buf)
{
unsigned short tmp = 0;
const unsigned char* bufend = buf + FIFO_SIZE*2;
do
{
tmp = (unsigned short) *buf++;
tmp |= (unsigned short) *buf++ << 8;
DATA_REG = tmp;
} while (buf < bufend); /* tail loop is faster */
}
static bool sd_select_bank(unsigned char bank)
{
unsigned int response;
unsigned char card_data[512];
unsigned char* write_buf;
int i;
memset(card_data, 0, 512);
sd_wait_for_state(TRAN, EC_TRAN_SEL_BANK);
BLOCK_SIZE_REG = 512;
BLOCK_COUNT_REG = 1;
if (!sd_command(35, 0, &response, 0x1c0d)) /* CMD35 is vendor specific */
return false;
SD_STATE_REG = PRG;
card_data[0] = bank;
/* Write the card data */
write_buf = card_data;
for (i = 0; i < BLOCK_SIZE / 2; i += FIFO_SIZE)
{
/* Wait for the FIFO to empty */
sd_poll_status(FIFO_EMPTY, 10000, EC_FIFO_SEL_BANK_EMPTY | DO_PANIC);
copy_write_sectors(write_buf); /* Copy one chunk of 16 words */
write_buf += FIFO_SIZE*2; /* Advance one chunk of 16 words */
}
sd_poll_status(DATA_DONE, 10000, EC_FIFO_SEL_BANK_DONE | DO_PANIC);
currcard->current_bank = bank;
return true;
}
/* lock must already be aquired */
static void sd_init_device(int card_no)
{
/* SD Protocol registers */
unsigned int i, dummy;
unsigned int c_size = 0;
unsigned long c_mult = 0;
unsigned char carddata[512];
unsigned char *dataptr;
/* Enable and initialise controller */
REG_1 = 6;
currcard = &card_info[card_no];
/* Initialise card data as blank */
memset(currcard, 0, sizeof(*currcard));
if (card_no == 0)
{
outl(inl(0x70000080) | 0x4, 0x70000080);
GPIOA_ENABLE &= ~0x7a;
GPIOA_OUTPUT_EN &= ~0x7a;
GPIOD_ENABLE |= 0x1f;
GPIOD_OUTPUT_VAL |= 0x1f;
GPIOD_OUTPUT_EN |= 0x1f;
outl((inl(0x70000014) & ~(0x3ffff)) | 0x255aa, 0x70000014);
}
else
{
outl(inl(0x70000080) & ~0x4, 0x70000080);
GPIOD_ENABLE &= ~0x1f;
GPIOD_OUTPUT_EN &= ~0x1f;
GPIOA_ENABLE |= 0x7a;
GPIOA_OUTPUT_VAL |= 0x7a;
GPIOA_OUTPUT_EN |= 0x7a;
outl(inl(0x70000014) & ~(0x3ffff), 0x70000014);
}
/* Init NAND */
REG_11 |= (1 << 15);
REG_12 |= (1 << 15);
REG_12 &= ~(3 << 12);
REG_12 |= (1 << 13);
REG_11 &= ~(3 << 12);
REG_11 |= (1 << 13);
DEV_EN |= DEV_ATA; /* Enable controller */
DEV_RS |= DEV_ATA; /* Reset controller */
DEV_RS &=~DEV_ATA; /* Clear Reset */
SD_STATE_REG = TRAN;
REG_5 = 0xf;
if (!sd_command(GO_IDLE_STATE, 0, &dummy, 256))
goto card_init_error;
check_time[EC_POWER_UP] = USEC_TIMER;
while ((currcard->ocr & (1 << 31)) == 0) /* until card is powered up */
{
if (!sd_command(APP_CMD, currcard->rca, &dummy, 1))
goto card_init_error;
if (!sd_command(SD_APP_OP_COND, 0x100000, &currcard->ocr, 3))
goto card_init_error;
sd_check_timeout(5000000, EC_POWER_UP);
}
if (!sd_command(ALL_SEND_CID, 0, currcard->cid, 2))
goto card_init_error;
if (!sd_command(SEND_RELATIVE_ADDR, 0, &currcard->rca, 1))
goto card_init_error;
if (!sd_command(SEND_CSD, currcard->rca, currcard->csd, 2))
goto card_init_error;
/* These calculations come from the Sandisk SD card product manual */
c_size = ((currcard->csd[2] & 0x3ff) << 2) + (currcard->csd[1] >> 30) + 1;
c_mult = 4 << ((currcard->csd[1] >> 15) & 7);
currcard->max_read_bl_len = 1 << ((currcard->csd[2] >> 16) & 15);
currcard->block_size = BLOCK_SIZE; /* Always use 512 byte blocks */
currcard->numblocks = c_size * c_mult * (currcard->max_read_bl_len / 512);
currcard->capacity = currcard->numblocks * currcard->block_size;
REG_1 = 0;
if (!sd_command(SELECT_CARD, currcard->rca, &dummy, 129))
goto card_init_error;
if (!sd_command(APP_CMD, currcard->rca, &dummy, 1))
goto card_init_error;
if (!sd_command(SET_BUS_WIDTH, currcard->rca | 2, &dummy, 1)) /* 4 bit */
goto card_init_error;
if (!sd_command(SET_BLOCKLEN, currcard->block_size, &dummy, 1))
goto card_init_error;
BLOCK_SIZE_REG = currcard->block_size;
/* If this card is > 4Gb, then we need to enable bank switching */
if(currcard->numblocks >= BLOCKS_PER_BANK)
{
SD_STATE_REG = TRAN;
BLOCK_COUNT_REG = 1;
if (!sd_command(SWITCH_FUNC, 0x80ffffef, &dummy, 0x1c05))
goto card_init_error;
/* Read 512 bytes from the card.
The first 512 bits contain the status information
TODO: Do something useful with this! */
dataptr = carddata;
for (i = 0; i < BLOCK_SIZE / 2; i += FIFO_SIZE)
{
/* Wait for the FIFO to be full */
sd_poll_status(FIFO_FULL, 100000,
EC_FIFO_ENA_BANK_EMPTY | DO_PANIC);
copy_read_sectors_slow(&dataptr);
}
}
currcard->initialized = 1;
return;
/* Card failed to initialize so disable it */
card_init_error:
currcard->initialized = -1;
}
/* API Functions */
void ata_led(bool onoff)
{
led(onoff);
}
int ata_read_sectors(IF_MV2(int drive,) unsigned long start, int incount,
void* inbuf)
{
int ret = -9;
unsigned char *buf, *buf_end;
unsigned int dummy;
int bank;
/* TODO: Add DMA support. */
spinlock_lock(&sd_mtx);
ata_led(true);
if (drive != 0 && (GPIOA_INPUT_VAL & 0x80) != 0)
/* no external sd-card inserted */
goto ata_read_error;
if (&card_info[drive] != currcard || card_info[drive].initialized == 0)
{
sd_init_device(drive);
if (card_info[drive].initialized < 0)
goto ata_read_error;
}
last_disk_activity = current_tick;
bank = start / BLOCKS_PER_BANK;
if (currcard->current_bank != bank && !sd_select_bank(bank))
goto ata_read_error;
start -= bank * BLOCKS_PER_BANK;
sd_wait_for_state(TRAN, EC_TRAN_READ_ENTRY);
BLOCK_COUNT_REG = incount;
if (!sd_command(READ_MULTIPLE_BLOCK, start * BLOCK_SIZE, &dummy, 0x1c25))
goto ata_read_error;
/* TODO: Don't assume BLOCK_SIZE == SECTOR_SIZE */
buf_end = (unsigned char *)inbuf + incount * currcard->block_size;
for (buf = inbuf; buf < buf_end;)
{
/* Wait for the FIFO to be full */
sd_poll_status(FIFO_FULL, 0x80000, EC_FIFO_READ_FULL | DO_PANIC);
copy_read_sectors_fast(&buf); /* Copy one chunk of 16 words */
/* TODO: Switch bank if necessary */
}
last_disk_activity = current_tick;
#if 0
udelay(75);
#endif
if (!sd_command(STOP_TRANSMISSION, 0, &dummy, 1))
goto ata_read_error;
sd_wait_for_state(TRAN, EC_TRAN_READ_EXIT);
ret = 0;
ata_read_error:
ata_led(false);
spinlock_unlock(&sd_mtx);
return ret;
}
int ata_write_sectors(IF_MV2(int drive,) unsigned long start, int count,
const void* outbuf)
{
/* Write support is not finished yet */
/* TODO: The standard suggests using ACMD23 prior to writing multiple blocks
to improve performance */
unsigned int response;
void const* buf, *buf_end;
int ret = -9;
int bank;
spinlock_lock(&sd_mtx);
ata_led(true);
if (drive != 0 && (GPIOA_INPUT_VAL & 0x80) != 0)
/* no external sd-card inserted */
goto ata_write_error;
if (&card_info[drive] != currcard || card_info[drive].initialized == 0)
{
sd_init_device(drive);
if (card_info[drive].initialized < 0)
goto ata_write_error;
}
bank = start / BLOCKS_PER_BANK;
if (currcard->current_bank != bank && !sd_select_bank(bank))
goto ata_write_error;
start -= bank * BLOCKS_PER_BANK;
check_time[EC_WRITE_TIMEOUT] = USEC_TIMER;
sd_wait_for_state(TRAN, EC_TRAN_WRITE_ENTRY);
BLOCK_COUNT_REG = count;
if (!sd_command(WRITE_MULTIPLE_BLOCK, start * SECTOR_SIZE,
&response, 0x1c2d))
{
goto ata_write_error;
}
buf_end = outbuf + count * currcard->block_size;
for (buf = outbuf; buf < buf_end; buf += 2 * FIFO_SIZE)
{
if (buf >= buf_end - 2 * FIFO_SIZE)
{
/* Set SD_STATE_REG to PRG for the last buffer fill */
SD_STATE_REG = PRG;
}
udelay(2); /* needed here (loop is too fast :-) */
/* Wait for the FIFO to empty */
sd_poll_status(FIFO_EMPTY, 0x80000, EC_FIFO_WR_EMPTY | DO_PANIC);
copy_write_sectors(buf); /* Copy one chunk of 16 words */
/* TODO: Switch bank if necessary */
}
last_disk_activity = current_tick;
sd_poll_status(DATA_DONE, 0x80000, EC_FIFO_WR_DONE | DO_PANIC);
sd_check_timeout(0x80000, EC_WRITE_TIMEOUT);
if (!sd_command(STOP_TRANSMISSION, 0, &response, 1))
goto ata_write_error;
sd_wait_for_state(TRAN, EC_TRAN_WRITE_EXIT);
ret = 0;
ata_write_error:
ata_led(false);
spinlock_unlock(&sd_mtx);
return ret;
}
static void sd_thread(void) __attribute__((noreturn));
static void sd_thread(void)
{
struct event ev;
bool idle_notified = false;
while (1)
{
queue_wait_w_tmo(&sd_queue, &ev, HZ);
switch ( ev.id )
{
case SD_HOTSWAP:
{
int status = 0;
enum { SD_UNMOUNTED = 0x1, SD_MOUNTED = 0x2 };
/* Delay on insert and remove to prevent reading state if it is
just bouncing back and forth while card is sliding - delay on
insert is also required for the card to stabilize and accept
commands */
sleep(HZ/10);
/* Lock to keep us from messing with this variable while an init
may be in progress */
spinlock_lock(&sd_mtx);
card_info[1].initialized = false;
spinlock_unlock(&sd_mtx);
/* Either unmount because the card was pulled or unmount and
remount if already mounted since multiple messages may be
generated for the same event - like someone inserting a new
card before anything detects the old one pulled :) */
if (disk_unmount(1) != 0) /* release "by force" */
status |= SD_UNMOUNTED;
if (card_detect_target() && disk_mount(1) != 0) /* mount SD-CARD */
status |= SD_MOUNTED;
if (status & SD_UNMOUNTED)
queue_broadcast(SYS_HOTSWAP_EXTRACTED, 0);
if (status & SD_MOUNTED)
queue_broadcast(SYS_HOTSWAP_INSERTED, 0);
if (status)
queue_broadcast(SYS_FS_CHANGED, 0);
break;
} /* SD_HOTSWAP */
case SYS_TIMEOUT:
if (TIME_BEFORE(current_tick, last_disk_activity+(3*HZ)))
{
idle_notified = false;
}
else if (!idle_notified)
{
call_ata_idle_notifys(false);
idle_notified = true;
}
break;
}
}
}
void ata_spindown(int seconds)
{
(void)seconds;
}
bool ata_disk_is_active(void)
{
return 0;
}
void ata_sleep(void)
{
}
void ata_spin(void)
{
}
/* Hardware reset protocol as specified in chapter 9.1, ATA spec draft v5 */
int ata_hard_reset(void)
{
return 0;
}
int ata_soft_reset(void)
{
return 0;
}
void ata_enable(bool on)
{
if(on)
{
DEV_EN |= DEV_ATA; /* Enable controller */
}
else
{
DEV_EN &= ~DEV_ATA; /* Disable controller */
}
}
int ata_init(void)
{
int ret = 0;
ata_led(false);
/* NOTE: This init isn't dual core safe */
if (!initialized)
{
initialized = true;
spinlock_init(&sd_mtx);
spinlock_lock(&sd_mtx);
/* init controller */
outl(inl(0x70000088) & ~(0x4), 0x70000088);
outl(inl(0x7000008c) & ~(0x4), 0x7000008c);
outl(inl(0x70000084) | 0x4, 0x70000084);
outl(0x1010, 0x70000034);
GPIOG_ENABLE |= (0x3 << 5);
GPIOG_OUTPUT_EN |= (0x3 << 5);
GPIOG_OUTPUT_VAL |= (0x3 << 5);
/* enable card detection port - mask interrupt first */
GPIOA_INT_EN &= ~0x80;
GPIOA_OUTPUT_EN &= ~0x80;
GPIOA_ENABLE |= 0x80;
sd_init_device(0);
if (currcard->initialized <= 0)
ret = -1;
queue_init(&sd_queue, true);
create_thread(sd_thread, sd_stack, sizeof(sd_stack),
sd_thread_name IF_PRIO(, PRIORITY_SYSTEM) IF_COP(, CPU, false));
/* enable interupt for the mSD card */
sleep(HZ/10);
CPU_INT_EN = HI_MASK;
CPU_HI_INT_EN = GPIO0_MASK;
sd1_status = GPIOA_INPUT_VAL & 0x80;
GPIOA_INT_LEV = (GPIOA_INT_LEV & ~0x80) | (sd1_status ^ 0x80);
GPIOA_INT_CLR = 0x80;
GPIOA_INT_EN |= 0x80;
spinlock_unlock(&sd_mtx);
}
return ret;
}
/* move the sd-card info to mmc struct */
tCardInfo *card_get_info_target(int card_no)
{
int i, temp;
static tCardInfo card;
static const char mantissa[] = { /* *10 */
0, 10, 12, 13, 15, 20, 25, 30, 35, 40, 45, 50, 55, 60, 70, 80 };
static const int exponent[] = { /* use varies */
1,10,100,1000,10000,100000,1000000,10000000,100000000,1000000000 };
card.initialized = card_info[card_no].initialized;
card.ocr = card_info[card_no].ocr;
for(i=0; i<4; i++) card.csd[i] = card_info[card_no].csd[3-i];
for(i=0; i<4; i++) card.cid[i] = card_info[card_no].cid[3-i];
card.numblocks = card_info[card_no].numblocks;
card.blocksize = card_info[card_no].block_size;
card.size = card_info[card_no].capacity < 0xffffffff ?
card_info[card_no].capacity : 0xffffffff;
card.block_exp = card_info[card_no].block_exp;
temp = card_extract_bits(card.csd, 29, 3);
card.speed = mantissa[card_extract_bits(card.csd, 25, 4)]
* exponent[temp > 2 ? 7 : temp + 4];
card.nsac = 100 * card_extract_bits(card.csd, 16, 8);
temp = card_extract_bits(card.csd, 13, 3);
card.tsac = mantissa[card_extract_bits(card.csd, 9, 4)]
* exponent[temp] / 10;
card.cid[0] = htobe32(card.cid[0]); /* ascii chars here */
card.cid[1] = htobe32(card.cid[1]); /* ascii chars here */
temp = *((char*)card.cid+13); /* adjust year<=>month, 1997 <=> 2000 */
*((char*)card.cid+13) = (unsigned char)((temp >> 4) | (temp << 4)) + 3;
return &card;
}
bool card_detect_target(void)
{
/* 0x00:inserted, 0x80:not inserted */
return (GPIOA_INPUT_VAL & 0x80) == 0;
}
/* called on insertion/removal interrupt */
void microsd_int(void)
{
int status = GPIOA_INPUT_VAL & 0x80;
GPIOA_INT_LEV = (GPIOA_INT_LEV & ~0x80) | (status ^ 0x80);
GPIOA_INT_CLR = 0x80;
if (status == sd1_status)
return;
sd1_status = status;
/* Take final state only - insert/remove is bouncy */
queue_remove_from_head(&sd_queue, SD_HOTSWAP);
queue_post(&sd_queue, SD_HOTSWAP, status);
}
Reference in a new issue View git blame Copy permalink