/*************************************************************************** * __________ __ ___. * Open \______ \ ____ ____ | | _\_ |__ _______ ___ * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ * \/ \/ \/ \/ \/ * $Id$ * * Copyright (C) 2006 Daniel Ankers * Copyright © 2008-2009 Rafaël Carré * * This program is free software; you can redistribute it and/or * modify it under the terms of the GNU General Public License * as published by the Free Software Foundation; either version 2 * of the License, or (at your option) any later version. * * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY * KIND, either express or implied. * ****************************************************************************/ #include "config.h" /* for HAVE_MULTIVOLUME */ #include "fat.h" #include "thread.h" #include "led.h" #include "hotswap.h" #include "system.h" #include "kernel.h" #include "cpu.h" #include #include #include #include "as3525v2.h" #include "pl081.h" /* DMA controller */ #include "dma-target.h" /* DMA request lines */ #include "clock-target.h" #include "panic.h" #include "stdbool.h" #include "ata_idle_notify.h" #include "sd.h" #include "usb.h" #ifdef HAVE_HOTSWAP #include "disk.h" #endif #include "lcd.h" #include #include "sysfont.h" #define INTERNAL_AS3525 0 /* embedded SD card */ #define SD_SLOT_AS3525 1 /* SD slot if present */ /* command flags */ #define MCI_NO_RESP (0<<0) #define MCI_RESP (1<<0) #define MCI_LONG_RESP (1<<1) /* controller registers */ #define SD_BASE 0xC6070000 #define SD_REG(x) (*(volatile unsigned long *) (SD_BASE+x)) #define MCI_CTRL SD_REG(0x00) /* control bits */ #define CTRL_RESET (1<<0) #define FIFO_RESET (1<<1) #define DMA_RESET (1<<2) #define INT_ENABLE (1<<4) #define DMA_ENABLE (1<<5) #define READ_WAIT (1<<6) #define SEND_IRQ_RESP (1<<7) #define ABRT_READ_DATA (1<<8) #define SEND_CCSD (1<<9) #define SEND_AS_CCSD (1<<10) #define EN_OD_PULLUP (1<<24) #define MCI_PWREN SD_REG(0x04) /* power enable */ #define PWR_CRD_0 (1<<0) #define PWR_CRD_1 (1<<1) #define PWR_CRD_2 (1<<2) #define PWR_CRD_3 (1<<3) #define MCI_CLKDIV SD_REG(0x08) /* clock divider */ /* CLK_DIV_0 : bits 7:0 * CLK_DIV_1 : bits 15:8 * CLK_DIV_2 : bits 23:16 * CLK_DIV_3 : bits 31:24 */ #define MCI_CLKSRC SD_REG(0x0C) /* clock source */ /* CLK_SRC_CRD0: bits 1:0 * CLK_SRC_CRD1: bits 3:2 * CLK_SRC_CRD2: bits 5:4 * CLK_SRC_CRD3: bits 7:6 */ #define MCI_CLKENA SD_REG(0x10) /* clock enable */ #define CCLK_ENA_CRD0 (1<<0) #define CCLK_ENA_CRD1 (1<<1) #define CCLK_ENA_CRD2 (1<<2) #define CCLK_ENA_CRD3 (1<<3) #define CCLK_LP_CRD0 (1<<16) /* LP --> Low Power Mode? */ #define CCLK_LP_CRD1 (1<<17) #define CCLK_LP_CRD2 (1<<18) #define CCLK_LP_CRD3 (1<<19) #define MCI_TMOUT SD_REG(0x14) /* timeout */ /* response timeout bits 0:7 * data timeout bits 8:31 */ #define MCI_CTYPE SD_REG(0x18) /* card type */ /* 1 bit per card, set = wide bus */ #define WIDTH4_CRD0 (1<<0) #define WIDTH4_CRD1 (1<<1) #define WIDTH4_CRD2 (1<<2) #define WIDTH4_CRD3 (1<<3) #define MCI_BLKSIZ SD_REG(0x1C) /* block size bits 0:15*/ #define MCI_BYTCNT SD_REG(0x20) /* byte count bits 0:31*/ #define MCI_MASK SD_REG(0x24) /* interrupt mask */ #define MCI_ARGUMENT SD_REG(0x28) #define MCI_COMMAND SD_REG(0x2C) /* command bits (bits 5:0 are the command index) */ #define CMD_RESP_EXP_BIT (1<<6) #define CMD_RESP_LENGTH_BIT (1<<7) #define CMD_CHECK_CRC_BIT (1<<8) #define CMD_DATA_EXP_BIT (1<<9) #define CMD_RW_BIT (1<<10) #define CMD_TRANSMODE_BIT (1<<11) #define CMD_SENT_AUTO_STOP_BIT (1<<12) #define CMD_WAIT_PRV_DAT_BIT (1<<13) #define CMD_ABRT_CMD_BIT (1<<14) #define CMD_SEND_INIT_BIT (1<<15) #define CMD_CARD_NO(x) ((x)<<16) /* 5 bits wide */ #define CMD_SEND_CLK_ONLY (1<<21) #define CMD_READ_CEATA (1<<22) #define CMD_CCS_EXPECTED (1<<23) #define CMD_DONE_BIT (1<<31) #define TRANSFER_CMD (cmd == SD_READ_MULTIPLE_BLOCK || \ cmd == SD_WRITE_MULTIPLE_BLOCK) #define MCI_RESP0 SD_REG(0x30) #define MCI_RESP1 SD_REG(0x34) #define MCI_RESP2 SD_REG(0x38) #define MCI_RESP3 SD_REG(0x3C) #define MCI_MASK_STATUS SD_REG(0x40) /* masked interrupt status */ #define MCI_RAW_STATUS SD_REG(0x44) /* raw interrupt status, also used as * status clear */ /* interrupt bits */ /* C D E (Cmd) (Data) (End) */ #define MCI_INT_CRDDET (1<<0) /* card detect */ #define MCI_INT_RE (1<<1) /* x response error */ #define MCI_INT_CD (1<<2) /* x command done */ #define MCI_INT_DTO (1<<3) /* x data transfer over */ #define MCI_INT_TXDR (1<<4) /* tx fifo data request */ #define MCI_INT_RXDR (1<<5) /* rx fifo data request */ #define MCI_INT_RCRC (1<<6) /* x response crc error */ #define MCI_INT_DCRC (1<<7) /* x data crc error */ #define MCI_INT_RTO (1<<8) /* x response timeout */ #define MCI_INT_DRTO (1<<9) /* x data read timeout */ #define MCI_INT_HTO (1<<10) /* x data starv timeout */ #define MCI_INT_FRUN (1<<11) /* x fifo over/underrun */ #define MCI_INT_HLE (1<<12) /* x x hw locked while error */ #define MCI_INT_SBE (1<<13) /* x start bit error */ #define MCI_INT_ACD (1<<14) /* auto command done */ #define MCI_INT_EBE (1<<15) /* x end bit error */ #define MCI_INT_SDIO (0xf<<16) /* * STATUS register * & 0xBA80 = MCI_INT_DCRC | MCI_INT_DRTO | MCI_INT_FRUN | \ * MCI_INT_HLE | MCI_INT_SBE | MCI_INT_EBE * & 8 = MCI_INT_DTO * & 0x428 = MCI_INT_DTO | MCI_INT_RXDR | MCI_INT_HTO * & 0x418 = MCI_INT_DTO | MCI_INT_TXDR | MCI_INT_HTO */ #define MCI_CMD_ERROR \ (MCI_INT_RE | \ MCI_INT_RCRC | \ MCI_INT_RTO | \ MCI_INT_HLE) #define MCI_DATA_ERROR \ ( MCI_INT_DCRC | \ MCI_INT_DRTO | \ MCI_INT_HTO | \ MCI_INT_FRUN | \ MCI_INT_HLE | \ MCI_INT_SBE | \ MCI_INT_EBE) #define MCI_STATUS SD_REG(0x48) #define FIFO_RX_WM (1<<0) #define FIFO_TX_WM (1<<1) #define FIFO_EMPTY (1<<2) #define FIFO_FULL (1<<3) #define CMD_FSM_STATE_B0 (1<<4) #define CMD_FSM_STATE_B1 (1<<5) #define CMD_FSM_STATE_B2 (1<<6) #define CMD_FSM_STATE_B3 (1<<7) #define DATA_3_STAT (1<<8) #define DATA_BUSY (1<<9) #define DATA_STAT_MC_BUSY (1<<10) #define RESP_IDX_B0 (1<<11) #define RESP_IDX_B1 (1<<12) #define RESP_IDX_B2 (1<<13) #define RESP_IDX_B3 (1<<14) #define RESP_IDX_B4 (1<<15) #define RESP_IDX_B5 (1<<16) #define FIFO_CNT_B00 (1<<17) #define FIFO_CNT_B01 (1<<18) #define FIFO_CNT_B02 (1<<19) #define FIFO_CNT_B03 (1<<20) #define FIFO_CNT_B04 (1<<21) #define FIFO_CNT_B05 (1<<22) #define FIFO_CNT_B06 (1<<23) #define FIFO_CNT_B07 (1<<24) #define FIFO_CNT_B08 (1<<25) #define FIFO_CNT_B09 (1<<26) #define FIFO_CNT_B10 (1<<27) #define FIFO_CNT_B11 (1<<28) #define FIFO_CNT_B12 (1<<29) #define DMA_ACK (1<<30) #define START_CMD (1<<31) #define MCI_FIFOTH SD_REG(0x4C) /* FIFO threshold */ /* TX watermark : bits 11:0 * RX watermark : bits 27:16 * DMA MTRANS SIZE : bits 30:28 * bits 31, 15:12 : unused */ #define MCI_FIFOTH_MASK 0x8000f000 #define MCI_CDETECT SD_REG(0x50) /* card detect */ #define CDETECT_CRD_0 (1<<0) #define CDETECT_CRD_1 (1<<1) #define CDETECT_CRD_2 (1<<2) #define CDETECT_CRD_3 (1<<3) #define MCI_WRTPRT SD_REG(0x54) /* write protect */ #define MCI_GPIO SD_REG(0x58) #define MCI_TCBCNT SD_REG(0x5C) /* transferred CIU byte count (card)*/ #define MCI_TBBCNT SD_REG(0x60) /* transferred host/DMA to/from bytes (FIFO)*/ #define MCI_DEBNCE SD_REG(0x64) /* card detect debounce bits 23:0*/ #define MCI_USRID SD_REG(0x68) /* user id */ #define MCI_VERID SD_REG(0x6C) /* version id */ #define MCI_HCON SD_REG(0x70) /* hardware config */ /* bit 0 : card type * bits 5:1 : maximum card index * bit 6 : BUS TYPE * bits 9:7 : DATA WIDTH * bits 15:10 : ADDR WIDTH * bits 17:16 : DMA IF * bits 20:18 : DMA WIDTH * bit 21 : FIFO RAM INSIDE * bit 22 : IMPL HOLD REG * bit 23 : SET CLK FALSE * bits 25:24 : MAX CLK DIV IDX * bit 26 : AREA OPTIM */ #define MCI_BMOD SD_REG(0x80) /* bus mode */ /* bit 0 : SWR * bit 1 : FB * bits 6:2 : DSL * bit 7 : DE * bit 10:8 : PBL */ #define MCI_PLDMND SD_REG(0x84) /* poll demand */ #define MCI_DBADDR SD_REG(0x88) /* descriptor base address */ #define MCI_IDSTS SD_REG(0x8C) /* internal DMAC status */ /* bit 0 : TI * bit 1 : RI * bit 2 : FBE * bit 3 : unused * bit 4 : DU * bit 5 : CES * bits 7:6 : unused * bits 8 : NIS * bit 9 : AIS * bits 12:10 : EB * bits 16:13 : FSM */ #define MCI_IDINTEN SD_REG(0x90) /* internal DMAC interrupt enable */ /* bit 0 : TI * bit 1 : RI * bit 2 : FBE * bit 3 : unused * bit 4 : DU * bit 5 : CES * bits 7:6 : unused * bits 8 : NI * bit 9 : AI */ #define MCI_DSCADDR SD_REG(0x94) /* current host descriptor address */ #define MCI_BUFADDR SD_REG(0x98) /* current host buffer address */ #define MCI_FIFO ((unsigned long *) (SD_BASE+0x100)) #define UNALIGNED_NUM_SECTORS 10 static unsigned char aligned_buffer[UNALIGNED_NUM_SECTORS* SD_BLOCK_SIZE] __attribute__((aligned(32))); /* align on cache line size */ static unsigned char *uncached_buffer = UNCACHED_ADDR(&aligned_buffer[0]); static void init_controller(void); static int sd_wait_for_state(const int drive, unsigned int state); static tCardInfo card_info[NUM_DRIVES]; /* for compatibility */ static long last_disk_activity = -1; #define MIN_YIELD_PERIOD 5 /* ticks */ static long next_yield = 0; static long sd_stack [(DEFAULT_STACK_SIZE*2 + 0x200)/sizeof(long)]; static const char sd_thread_name[] = "ata/sd"; static struct mutex sd_mtx SHAREDBSS_ATTR; static struct event_queue sd_queue; #ifndef BOOTLOADER bool sd_enabled = false; #endif static struct wakeup transfer_completion_signal; static struct wakeup command_completion_signal; static volatile bool retry; static volatile int cmd_error; #if defined(HAVE_MULTIDRIVE) int active_card = 0; #define EXT_SD_BITS (1<<2) #endif static inline void mci_delay(void) { udelay(1000); } void INT_NAND(void) { MCI_CTRL &= ~INT_ENABLE; /* use raw status here as we need to check some Ints that are masked */ const int status = MCI_RAW_STATUS; MCI_RAW_STATUS = status; /* clear status */ if(status & MCI_DATA_ERROR) retry = true; if( status & (MCI_INT_DTO|MCI_DATA_ERROR)) wakeup_signal(&transfer_completion_signal); cmd_error = status & MCI_CMD_ERROR; if(status & MCI_INT_CD) wakeup_signal(&command_completion_signal); MCI_CTRL |= INT_ENABLE; } static inline bool card_detect_target(void) { #if defined(HAVE_MULTIDRIVE) #if defined(SANSA_FUZEV2) return GPIOA_PIN(2); #elif defined(SANSA_CLIPPLUS) return !(GPIOA_PIN(2)); #else #error "microSD pin not defined for your target" #endif #else return false; #endif } static bool send_cmd(const int drive, const int cmd, const int arg, const int flags, unsigned long *response) { #if defined(HAVE_MULTIDRIVE) /* Check to see if we need to switch cards */ if(sd_present(SD_SLOT_AS3525)) if(active_card != drive) { GPIOB_PIN(5) = (1-drive) << 5; active_card = drive; } #endif /* RCRC & RTO interrupts should be set together with the CD interrupt but * in practice sometimes incorrectly precede the CD interrupt. If we leave * them masked for now we can check them in the isr by reading raw status when * the CD int is triggered. */ MCI_MASK |= MCI_INT_CD; MCI_ARGUMENT = arg; /* Construct MCI_COMMAND */ MCI_COMMAND = /*b5:0*/ cmd /*b6 */ | ((flags & MCI_RESP) ? CMD_RESP_EXP_BIT: 0) /*b7 */ | ((flags & MCI_LONG_RESP) ? CMD_RESP_LENGTH_BIT: 0) /*b8 | CMD_CHECK_CRC_BIT unused */ /*b9 */ | (TRANSFER_CMD ? CMD_DATA_EXP_BIT: 0) /*b10 */ | ((cmd == SD_WRITE_MULTIPLE_BLOCK) ? CMD_RW_BIT: 0) /*b11 | CMD_TRANSMODE_BIT unused */ /*b12 | CMD_SENT_AUTO_STOP_BIT unused */ /*b13 */ | (TRANSFER_CMD ? CMD_WAIT_PRV_DAT_BIT: 0) /*b14 | CMD_ABRT_CMD_BIT unused */ /*b15 | CMD_SEND_INIT_BIT unused */ /*b20:16 */ | CMD_CARD_NO(drive) /*b21 | CMD_SEND_CLK_ONLY unused */ /*b22 | CMD_READ_CEATA unused */ /*b23 | CMD_CCS_EXPECTED unused */ /*b31 */ | CMD_DONE_BIT; wakeup_wait(&command_completion_signal, TIMEOUT_BLOCK); MCI_MASK &= ~MCI_INT_CD; /* Handle command responses & errors */ if(flags & MCI_RESP) { if(cmd_error & (MCI_INT_RCRC | MCI_INT_RTO)) return false; if(flags & MCI_LONG_RESP) { response[0] = MCI_RESP3; response[1] = MCI_RESP2; response[2] = MCI_RESP1; response[3] = MCI_RESP0; } else response[0] = MCI_RESP0; } return true; } static int sd_init_card(const int drive) { unsigned long response; long init_timeout; bool sd_v2 = false; /* assume 24 MHz clock / 60 = 400 kHz */ MCI_CLKDIV = (MCI_CLKDIV & ~(0xFF)) | 0x3C; /* CLK_DIV_0 : bits 7:0 */ /* 100 - 400kHz clock required for Identification Mode */ /* Start of Card Identification Mode ************************************/ /* CMD0 Go Idle */ if(!send_cmd(drive, SD_GO_IDLE_STATE, 0, MCI_NO_RESP, NULL)) return -1; mci_delay(); /* CMD8 Check for v2 sd card. Must be sent before using ACMD41 Non v2 cards will not respond to this command*/ if(send_cmd(drive, SD_SEND_IF_COND, 0x1AA, MCI_RESP, &response)) if((response & 0xFFF) == 0x1AA) sd_v2 = true; /* timeout for initialization is 1sec, from SD Specification 2.00 */ init_timeout = current_tick + HZ; do { /* this timeout is the only valid error for this loop*/ if(TIME_AFTER(current_tick, init_timeout)) return -2; /* app_cmd */ send_cmd(drive, SD_APP_CMD, 0, MCI_RESP, &response); /* ACMD41 For v2 cards set HCS bit[30] & send host voltage range to all */ if(!send_cmd(drive, SD_APP_OP_COND, (0x00FF8000 | (sd_v2 ? 1<<30 : 0)), MCI_RESP, &card_info[drive].ocr)) return -3; } while(!(card_info[drive].ocr & (1<<31)) ); /* CMD2 send CID */ if(!send_cmd(drive, SD_ALL_SEND_CID, 0, MCI_RESP|MCI_LONG_RESP, card_info[drive].cid)) return -4; /* CMD3 send RCA */ if(!send_cmd(drive, SD_SEND_RELATIVE_ADDR, 0, MCI_RESP, &card_info[drive].rca)) return -5; #ifdef HAVE_MULTIDRIVE /* Make sure we have 2 unique rca numbers */ if(card_info[INTERNAL_AS3525].rca == card_info[SD_SLOT_AS3525].rca) if(!send_cmd(drive, SD_SEND_RELATIVE_ADDR, 0, MCI_RESP, &card_info[drive].rca)) return -6; #endif /* End of Card Identification Mode ************************************/ /* Attempt to switch cards to HS timings, non HS cards just ignore this */ /* CMD7 w/rca: Select card to put it in TRAN state */ if(!send_cmd(drive, SD_SELECT_CARD, card_info[drive].rca, MCI_NO_RESP, NULL)) return -7; if(sd_wait_for_state(drive, SD_TRAN)) return -8; /* CMD6 */ if(!send_cmd(drive, SD_SWITCH_FUNC, 0x80fffff1, MCI_NO_RESP, NULL)) return -9; mci_delay(); /* We need to go back to STBY state now so we can read csd */ /* CMD7 w/rca=0: Deselect card to put it in STBY state */ if(!send_cmd(drive, SD_DESELECT_CARD, 0, MCI_NO_RESP, NULL)) return -10; /* CMD9 send CSD */ if(!send_cmd(drive, SD_SEND_CSD, card_info[drive].rca, MCI_RESP|MCI_LONG_RESP, card_info[drive].csd)) return -11; sd_parse_csd(&card_info[drive]); /* Card back to full speed */ MCI_CLKDIV &= ~(0xFF); /* CLK_DIV_0 : bits 7:0 = 0x00 */ /* CMD7 w/rca: Select card to put it in TRAN state */ if(!send_cmd(drive, SD_SELECT_CARD, card_info[drive].rca, MCI_NO_RESP, NULL)) return -12; #ifndef BOOTLOADER /* Switch to to 4 bit widebus mode */ if(sd_wait_for_state(drive, SD_TRAN) < 0) return -13; /* CMD55 */ /* Response is requested due to timing issue */ if(!send_cmd(drive, SD_APP_CMD, card_info[drive].rca, MCI_RESP, &response)) return -14; /* ACMD6 */ if(!send_cmd(drive, SD_SET_BUS_WIDTH, 2, MCI_NO_RESP, NULL)) return -15; mci_delay(); /* CMD55 */ /* Response is requested due to timing issue */ if(!send_cmd(drive, SD_APP_CMD, card_info[drive].rca, MCI_RESP, &response)) return -16; /* ACMD42 */ if(!send_cmd(drive, SD_SET_CLR_CARD_DETECT, 0, MCI_NO_RESP, NULL)) return -17; /* Now that card is widebus make controller aware */ MCI_CTYPE |= (1<>1) & 0x1F) + 1; int card_mask = (1 << hcon_numcards) - 1; MCI_PWREN &= ~card_mask; /* power off all cards */ MCI_CLKSRC = 0x00; /* All CLK_SRC_CRD set to 0*/ MCI_CLKDIV = 0x00; /* CLK_DIV_0 : bits 7:0 */ MCI_PWREN |= card_mask; /* power up cards */ mci_delay(); MCI_CTRL |= CTRL_RESET; while(MCI_CTRL & CTRL_RESET) ; MCI_RAW_STATUS = 0xffffffff; /* Clear all MCI Interrupts */ MCI_TMOUT = 0xffffffff; /* data b31:8, response b7:0 */ MCI_CTYPE = 0x0; /* all cards 1 bit bus for now */ MCI_CLKENA = card_mask; /* Enables card clocks */ MCI_ARGUMENT = 0; MCI_COMMAND = CMD_DONE_BIT|CMD_SEND_CLK_ONLY|CMD_WAIT_PRV_DAT_BIT; while(MCI_COMMAND & CMD_DONE_BIT) ; MCI_DEBNCE = 0xfffff; /* default value */ /* Rx watermark = 63(sd reads) Tx watermark = 128 (sd writes) */ MCI_FIFOTH = (MCI_FIFOTH & MCI_FIFOTH_MASK) | 0x503f0080; GPIOB_DIR |= (1<<5); /* Set pin B5 to output */ /* Mask all MCI Interrupts initially */ MCI_MASK = 0; MCI_CTRL |= INT_ENABLE; } int sd_init(void) { int ret; CGU_PERI |= CGU_MCI_CLOCK_ENABLE; CGU_IDE = (1<<7) /* AHB interface enable */ | (AS3525_IDE_DIV << 2) | 1; /* clock source = PLLA */ CGU_MEMSTICK = (1<<7) /* interface enable */ | (AS3525_MS_DIV << 2) | 1; /* clock source = PLLA */ CGU_SDSLOT = (1<<7) /* interface enable */ | (AS3525_SDSLOT_DIV << 2) | 1; /* clock source = PLLA */ wakeup_init(&transfer_completion_signal); wakeup_init(&command_completion_signal); #ifdef HAVE_MULTIDRIVE /* clear previous irq */ GPIOA_IC = EXT_SD_BITS; /* enable edge detecting */ GPIOA_IS &= ~EXT_SD_BITS; /* detect both raising and falling edges */ GPIOA_IBE |= EXT_SD_BITS; /* Configure XPD for SD-MCI interface */ CCU_IO |= (1<<2); #endif VIC_INT_ENABLE = INTERRUPT_NAND; init_controller(); ret = sd_init_card(INTERNAL_AS3525); if(ret < 0) return ret; /* init mutex */ mutex_init(&sd_mtx); queue_init(&sd_queue, true); create_thread(sd_thread, sd_stack, sizeof(sd_stack), 0, sd_thread_name IF_PRIO(, PRIORITY_USER_INTERFACE) IF_COP(, CPU)); #ifndef BOOTLOADER sd_enabled = true; sd_enable(false); #endif return 0; } static int sd_wait_for_state(const int drive, unsigned int state) { unsigned long response; unsigned int timeout = 100; /* ticks */ long t = current_tick; while (1) { long tick; while(!(send_cmd(drive, SD_SEND_STATUS, card_info[drive].rca, MCI_RESP, &response))); if (((response >> 9) & 0xf) == state) return 0; if(TIME_AFTER(current_tick, t + timeout)) return -10 * ((response >> 9) & 0xf); if (TIME_AFTER((tick = current_tick), next_yield)) { yield(); timeout += current_tick - tick; next_yield = tick + MIN_YIELD_PERIOD; } } } static int sd_transfer_sectors(IF_MD2(int drive,) unsigned long start, int count, void* buf, bool write) { int ret = 0; #ifndef HAVE_MULTIDRIVE const int drive = 0; #endif /* skip SanDisk OF */ if (drive == INTERNAL_AS3525) start += 0xf000; mutex_lock(&sd_mtx); #ifndef BOOTLOADER sd_enable(true); led(true); #endif if (card_info[drive].initialized <= 0) { ret = sd_init_card(drive); if (!(card_info[drive].initialized)) { panicf("card not initialised (%d)", ret); goto sd_transfer_error; } } /* CMD7 w/rca: Select card to put it in TRAN state */ if(!send_cmd(drive, SD_SELECT_CARD, card_info[drive].rca, MCI_NO_RESP, NULL)) return -18; last_disk_activity = current_tick; dma_retain(); const int cmd = write ? SD_WRITE_MULTIPLE_BLOCK : SD_READ_MULTIPLE_BLOCK; do { void *dma_buf = aligned_buffer; unsigned int transfer = count; if(transfer > UNALIGNED_NUM_SECTORS) transfer = UNALIGNED_NUM_SECTORS; if(write) memcpy(uncached_buffer, buf, transfer * SD_BLOCK_SIZE); /* Interrupt handler might set this to true during transfer */ retry = false; MCI_BLKSIZ = SD_BLOCK_SIZE; MCI_BYTCNT = transfer * SD_BLOCK_SIZE; ret = sd_wait_for_state(drive, SD_TRAN); if (ret < 0) { static const char *st[9] = { "IDLE", "RDY", "IDENT", "STBY", "TRAN", "DATA", "RCV", "PRG", "DIS"}; if(ret <= -10) panicf("wait for TRAN state failed (%s) %d", st[(-ret / 10) % 9], drive); else panicf("wait for state failed"); goto sd_transfer_error; } int arg = start; if(!(card_info[drive].ocr & (1<<30))) /* not SDHC */ arg *= SD_BLOCK_SIZE; if(write) dma_enable_channel(0, dma_buf, MCI_FIFO, DMA_PERI_SD, DMAC_FLOWCTRL_PERI_MEM_TO_PERI, true, false, 0, DMA_S8, NULL); else dma_enable_channel(0, MCI_FIFO, dma_buf, DMA_PERI_SD, DMAC_FLOWCTRL_PERI_PERI_TO_MEM, false, true, 0, DMA_S8, NULL); MCI_MASK |= (MCI_DATA_ERROR | MCI_INT_DTO); MCI_CTRL |= DMA_ENABLE; unsigned long dummy; /* if we don't ask for a response, writing fails */ if(!send_cmd(drive, cmd, arg, MCI_RESP, &dummy)) panicf("%s multiple blocks failed", write ? "write" : "read"); wakeup_wait(&transfer_completion_signal, TIMEOUT_BLOCK); MCI_MASK &= ~(MCI_DATA_ERROR | MCI_INT_DTO); last_disk_activity = current_tick; if(!send_cmd(drive, SD_STOP_TRANSMISSION, 0, MCI_NO_RESP, NULL)) { ret = -666; panicf("STOP TRANSMISSION failed"); goto sd_transfer_error; } if(!retry) { if(!write) memcpy(buf, uncached_buffer, transfer * SD_BLOCK_SIZE); buf += transfer * SD_BLOCK_SIZE; start += transfer; count -= transfer; } else /* reset controller if we had an error */ { MCI_CTRL |= (FIFO_RESET|DMA_RESET); while(MCI_CTRL & (FIFO_RESET|DMA_RESET)) ; } } while(retry || count); dma_release(); /* CMD lines are separate, not common, so we need to actively deselect */ /* CMD7 w/rca =0 : deselects card & puts it in STBY state */ if(!send_cmd(drive, SD_DESELECT_CARD, 0, MCI_NO_RESP, NULL)) return -19; #ifndef BOOTLOADER sd_enable(false); led(false); #endif mutex_unlock(&sd_mtx); return 0; sd_transfer_error: panicf("transfer error : %d",ret); card_info[drive].initialized = 0; return ret; } int sd_read_sectors(IF_MD2(int drive,) unsigned long start, int count, void* buf) { return sd_transfer_sectors(IF_MD2(drive,) start, count, buf, false); } int sd_write_sectors(IF_MD2(int drive,) unsigned long start, int count, const void* buf) { #if defined(BOOTLOADER) /* we don't need write support in bootloader */ #ifdef HAVE_MULTIDRIVE (void) drive; #endif (void) start; (void) count; (void) buf; return -1; #else return sd_transfer_sectors(IF_MD2(drive,) start, count, (void*)buf, true); #endif /* defined(BOOTLOADER) */ } #ifndef BOOTLOADER long sd_last_disk_activity(void) { return last_disk_activity; } void sd_enable(bool on) { /* TODO */ (void) on; } tCardInfo *card_get_info_target(int card_no) { return &card_info[card_no]; } #endif /* BOOTLOADER */ #ifdef HAVE_HOTSWAP bool sd_removable(IF_MD_NONVOID(int drive)) { return (drive==1); } bool sd_present(IF_MD_NONVOID(int drive)) { return (drive == 0) ? true : card_detect_target(); } static int sd1_oneshot_callback(struct timeout *tmo) { (void)tmo; /* This is called only if the state was stable for 300ms - check state * and post appropriate event. */ if (card_detect_target()) { queue_broadcast(SYS_HOTSWAP_INSERTED, 0); } else queue_broadcast(SYS_HOTSWAP_EXTRACTED, 0); return 0; } void sd_gpioa_isr(void) { static struct timeout sd1_oneshot; if (GPIOA_MIS & EXT_SD_BITS) timeout_register(&sd1_oneshot, sd1_oneshot_callback, (3*HZ/10), 0); /* acknowledge interrupt */ GPIOA_IC = EXT_SD_BITS; } void card_enable_monitoring_target(bool on) { if (on) /* enable interrupt */ GPIOA_IE |= EXT_SD_BITS; else /* disable interrupt */ GPIOA_IE &= ~EXT_SD_BITS; } #endif /* HAVE_HOTSWAP */ #ifdef CONFIG_STORAGE_MULTI int sd_num_drives(int first_drive) { /* We don't care which logical drive number(s) we have been assigned */ (void)first_drive; return NUM_DRIVES; } #endif /* CONFIG_STORAGE_MULTI */