SD card: store sample code for the hardware layer.
Fetched from http://elm-chan.org/fsw/ff/00index_p.html. There is also sample code for the bigger brother, FatFs, here: http://elm-chan.org/fsw/ff/00index_e.html. These FatFs examples are bigger (600 lines of code vs. 260 lines), but are also for a lot more platforms available.
This commit is contained in:
Markus Hitter
parent
0a013d6e5e
commit
fe9ef63225
|
|
@ -0,0 +1,261 @@
|
||||||
|
/*-------------------------------------------------------------------------*/
|
||||||
|
/* PFF - Low level disk control module for AVR (C)ChaN, 2014 */
|
||||||
|
/*-------------------------------------------------------------------------*/
|
||||||
|
|
||||||
|
#include "pff.h"
|
||||||
|
#include "diskio.h"
|
||||||
|
|
||||||
|
/*-------------------------------------------------------------------------*/
|
||||||
|
/* Platform dependent macros and functions needed to be modified */
|
||||||
|
/*-------------------------------------------------------------------------*/
|
||||||
|
|
||||||
|
#include <avr/io.h> /* Device specific include files */
|
||||||
|
|
||||||
|
#define SELECT() PORTB &= ~_BV(3) /* CS = L */
|
||||||
|
#define DESELECT() PORTB |= _BV(3) /* CS = H */
|
||||||
|
#define SELECTING !(PORTB & _BV(3)) /* CS status (true:CS low) */
|
||||||
|
#define FORWARD(d) xmit(d) /* Data forwarding function (console out) */
|
||||||
|
|
||||||
|
void xmit (char); /* suart.S: Send a byte via software UART */
|
||||||
|
void dly_100us (void); /* usi.S: Delay 100 microseconds */
|
||||||
|
void init_spi (void); /* usi.S: Initialize MMC control ports */
|
||||||
|
void xmit_spi (BYTE d); /* usi.S: Send a byte to the MMC */
|
||||||
|
BYTE rcv_spi (void); /* usi.S: Send a 0xFF to the MMC and get the received byte */
|
||||||
|
|
||||||
|
|
||||||
|
/*--------------------------------------------------------------------------
|
||||||
|
|
||||||
|
Module Private Functions
|
||||||
|
|
||||||
|
---------------------------------------------------------------------------*/
|
||||||
|
|
||||||
|
/* Definitions for MMC/SDC command */
|
||||||
|
#define CMD0 (0x40+0) /* GO_IDLE_STATE */
|
||||||
|
#define CMD1 (0x40+1) /* SEND_OP_COND (MMC) */
|
||||||
|
#define ACMD41 (0xC0+41) /* SEND_OP_COND (SDC) */
|
||||||
|
#define CMD8 (0x40+8) /* SEND_IF_COND */
|
||||||
|
#define CMD16 (0x40+16) /* SET_BLOCKLEN */
|
||||||
|
#define CMD17 (0x40+17) /* READ_SINGLE_BLOCK */
|
||||||
|
#define CMD24 (0x40+24) /* WRITE_BLOCK */
|
||||||
|
#define CMD55 (0x40+55) /* APP_CMD */
|
||||||
|
#define CMD58 (0x40+58) /* READ_OCR */
|
||||||
|
|
||||||
|
|
||||||
|
/* Card type flags (CardType) */
|
||||||
|
#define CT_MMC 0x01 /* MMC ver 3 */
|
||||||
|
#define CT_SD1 0x02 /* SD ver 1 */
|
||||||
|
#define CT_SD2 0x04 /* SD ver 2 */
|
||||||
|
#define CT_BLOCK 0x08 /* Block addressing */
|
||||||
|
|
||||||
|
|
||||||
|
static
|
||||||
|
BYTE CardType;
|
||||||
|
|
||||||
|
|
||||||
|
/*-----------------------------------------------------------------------*/
|
||||||
|
/* Send a command packet to MMC */
|
||||||
|
/*-----------------------------------------------------------------------*/
|
||||||
|
|
||||||
|
static
|
||||||
|
BYTE send_cmd (
|
||||||
|
BYTE cmd, /* 1st byte (Start + Index) */
|
||||||
|
DWORD arg /* Argument (32 bits) */
|
||||||
|
)
|
||||||
|
{
|
||||||
|
BYTE n, res;
|
||||||
|
|
||||||
|
|
||||||
|
if (cmd & 0x80) { /* ACMD<n> is the command sequense of CMD55-CMD<n> */
|
||||||
|
cmd &= 0x7F;
|
||||||
|
res = send_cmd(CMD55, 0);
|
||||||
|
if (res > 1) return res;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Select the card */
|
||||||
|
DESELECT();
|
||||||
|
rcv_spi();
|
||||||
|
SELECT();
|
||||||
|
rcv_spi();
|
||||||
|
|
||||||
|
/* Send a command packet */
|
||||||
|
xmit_spi(cmd); /* Start + Command index */
|
||||||
|
xmit_spi((BYTE)(arg >> 24)); /* Argument[31..24] */
|
||||||
|
xmit_spi((BYTE)(arg >> 16)); /* Argument[23..16] */
|
||||||
|
xmit_spi((BYTE)(arg >> 8)); /* Argument[15..8] */
|
||||||
|
xmit_spi((BYTE)arg); /* Argument[7..0] */
|
||||||
|
n = 0x01; /* Dummy CRC + Stop */
|
||||||
|
if (cmd == CMD0) n = 0x95; /* Valid CRC for CMD0(0) */
|
||||||
|
if (cmd == CMD8) n = 0x87; /* Valid CRC for CMD8(0x1AA) */
|
||||||
|
xmit_spi(n);
|
||||||
|
|
||||||
|
/* Receive a command response */
|
||||||
|
n = 10; /* Wait for a valid response in timeout of 10 attempts */
|
||||||
|
do {
|
||||||
|
res = rcv_spi();
|
||||||
|
} while ((res & 0x80) && --n);
|
||||||
|
|
||||||
|
return res; /* Return with the response value */
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
/*--------------------------------------------------------------------------
|
||||||
|
|
||||||
|
Public Functions
|
||||||
|
|
||||||
|
---------------------------------------------------------------------------*/
|
||||||
|
|
||||||
|
/*-----------------------------------------------------------------------*/
|
||||||
|
/* Initialize Disk Drive */
|
||||||
|
/*-----------------------------------------------------------------------*/
|
||||||
|
|
||||||
|
DSTATUS disk_initialize (void)
|
||||||
|
{
|
||||||
|
BYTE n, cmd, ty, ocr[4];
|
||||||
|
UINT tmr;
|
||||||
|
|
||||||
|
#if _USE_WRITE
|
||||||
|
if (CardType && SELECTING) disk_writep(0, 0); /* Finalize write process if it is in progress */
|
||||||
|
#endif
|
||||||
|
init_spi(); /* Initialize ports to control MMC */
|
||||||
|
DESELECT();
|
||||||
|
for (n = 10; n; n--) rcv_spi(); /* 80 dummy clocks with CS=H */
|
||||||
|
|
||||||
|
ty = 0;
|
||||||
|
if (send_cmd(CMD0, 0) == 1) { /* GO_IDLE_STATE */
|
||||||
|
if (send_cmd(CMD8, 0x1AA) == 1) { /* SDv2 */
|
||||||
|
for (n = 0; n < 4; n++) ocr[n] = rcv_spi(); /* Get trailing return value of R7 resp */
|
||||||
|
if (ocr[2] == 0x01 && ocr[3] == 0xAA) { /* The card can work at vdd range of 2.7-3.6V */
|
||||||
|
for (tmr = 10000; tmr && send_cmd(ACMD41, 1UL << 30); tmr--) dly_100us(); /* Wait for leaving idle state (ACMD41 with HCS bit) */
|
||||||
|
if (tmr && send_cmd(CMD58, 0) == 0) { /* Check CCS bit in the OCR */
|
||||||
|
for (n = 0; n < 4; n++) ocr[n] = rcv_spi();
|
||||||
|
ty = (ocr[0] & 0x40) ? CT_SD2 | CT_BLOCK : CT_SD2; /* SDv2 (HC or SC) */
|
||||||
|
}
|
||||||
|
}
|
||||||
|
} else { /* SDv1 or MMCv3 */
|
||||||
|
if (send_cmd(ACMD41, 0) <= 1) {
|
||||||
|
ty = CT_SD1; cmd = ACMD41; /* SDv1 */
|
||||||
|
} else {
|
||||||
|
ty = CT_MMC; cmd = CMD1; /* MMCv3 */
|
||||||
|
}
|
||||||
|
for (tmr = 10000; tmr && send_cmd(cmd, 0); tmr--) dly_100us(); /* Wait for leaving idle state */
|
||||||
|
if (!tmr || send_cmd(CMD16, 512) != 0) /* Set R/W block length to 512 */
|
||||||
|
ty = 0;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
CardType = ty;
|
||||||
|
DESELECT();
|
||||||
|
rcv_spi();
|
||||||
|
|
||||||
|
return ty ? 0 : STA_NOINIT;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
/*-----------------------------------------------------------------------*/
|
||||||
|
/* Read partial sector */
|
||||||
|
/*-----------------------------------------------------------------------*/
|
||||||
|
|
||||||
|
DRESULT disk_readp (
|
||||||
|
BYTE *buff, /* Pointer to the read buffer (NULL:Forward to the stream) */
|
||||||
|
DWORD sector, /* Sector number (LBA) */
|
||||||
|
UINT offset, /* Byte offset to read from (0..511) */
|
||||||
|
UINT count /* Number of bytes to read (ofs + cnt mus be <= 512) */
|
||||||
|
)
|
||||||
|
{
|
||||||
|
DRESULT res;
|
||||||
|
BYTE rc;
|
||||||
|
UINT bc;
|
||||||
|
|
||||||
|
|
||||||
|
if (!(CardType & CT_BLOCK)) sector *= 512; /* Convert to byte address if needed */
|
||||||
|
|
||||||
|
res = RES_ERROR;
|
||||||
|
if (send_cmd(CMD17, sector) == 0) { /* READ_SINGLE_BLOCK */
|
||||||
|
|
||||||
|
bc = 40000; /* Time counter */
|
||||||
|
do { /* Wait for data packet */
|
||||||
|
rc = rcv_spi();
|
||||||
|
} while (rc == 0xFF && --bc);
|
||||||
|
|
||||||
|
if (rc == 0xFE) { /* A data packet arrived */
|
||||||
|
|
||||||
|
bc = 512 + 2 - offset - count; /* Number of trailing bytes to skip */
|
||||||
|
|
||||||
|
/* Skip leading bytes */
|
||||||
|
while (offset--) rcv_spi();
|
||||||
|
|
||||||
|
/* Receive a part of the sector */
|
||||||
|
if (buff) { /* Store data to the memory */
|
||||||
|
do {
|
||||||
|
*buff++ = rcv_spi();
|
||||||
|
} while (--count);
|
||||||
|
} else { /* Forward data to the outgoing stream */
|
||||||
|
do {
|
||||||
|
FORWARD(rcv_spi());
|
||||||
|
} while (--count);
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Skip trailing bytes and CRC */
|
||||||
|
do rcv_spi(); while (--bc);
|
||||||
|
|
||||||
|
res = RES_OK;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
DESELECT();
|
||||||
|
rcv_spi();
|
||||||
|
|
||||||
|
return res;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
/*-----------------------------------------------------------------------*/
|
||||||
|
/* Write partial sector */
|
||||||
|
/*-----------------------------------------------------------------------*/
|
||||||
|
|
||||||
|
#if _USE_WRITE
|
||||||
|
DRESULT disk_writep (
|
||||||
|
const BYTE *buff, /* Pointer to the bytes to be written (NULL:Initiate/Finalize sector write) */
|
||||||
|
DWORD sc /* Number of bytes to send, Sector number (LBA) or zero */
|
||||||
|
)
|
||||||
|
{
|
||||||
|
DRESULT res;
|
||||||
|
UINT bc;
|
||||||
|
static UINT wc; /* Sector write counter */
|
||||||
|
|
||||||
|
res = RES_ERROR;
|
||||||
|
|
||||||
|
if (buff) { /* Send data bytes */
|
||||||
|
bc = sc;
|
||||||
|
while (bc && wc) { /* Send data bytes to the card */
|
||||||
|
xmit_spi(*buff++);
|
||||||
|
wc--; bc--;
|
||||||
|
}
|
||||||
|
res = RES_OK;
|
||||||
|
} else {
|
||||||
|
if (sc) { /* Initiate sector write process */
|
||||||
|
if (!(CardType & CT_BLOCK)) sc *= 512; /* Convert to byte address if needed */
|
||||||
|
if (send_cmd(CMD24, sc) == 0) { /* WRITE_SINGLE_BLOCK */
|
||||||
|
xmit_spi(0xFF); xmit_spi(0xFE); /* Data block header */
|
||||||
|
wc = 512; /* Set byte counter */
|
||||||
|
res = RES_OK;
|
||||||
|
}
|
||||||
|
} else { /* Finalize sector write process */
|
||||||
|
bc = wc + 2;
|
||||||
|
while (bc--) xmit_spi(0); /* Fill left bytes and CRC with zeros */
|
||||||
|
if ((rcv_spi() & 0x1F) == 0x05) { /* Receive data resp and wait for end of write process in timeout of 500ms */
|
||||||
|
for (bc = 5000; rcv_spi() != 0xFF && bc; bc--) /* Wait for ready */
|
||||||
|
dly_100us();
|
||||||
|
if (bc) res = RES_OK;
|
||||||
|
}
|
||||||
|
DESELECT();
|
||||||
|
rcv_spi();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
return res;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
@ -0,0 +1,290 @@
|
||||||
|
/*-------------------------------------------------------------------------*/
|
||||||
|
/* PFF - Low level disk control module for PIC (C)ChaN, 2014 */
|
||||||
|
/*-------------------------------------------------------------------------*/
|
||||||
|
|
||||||
|
#include "pff.h"
|
||||||
|
#include "diskio.h"
|
||||||
|
#include "uart.h"
|
||||||
|
|
||||||
|
/*-------------------------------------------------------------------------*/
|
||||||
|
/* Platform dependent macros and functions needed to be modified */
|
||||||
|
/*-------------------------------------------------------------------------*/
|
||||||
|
|
||||||
|
#include <p24FJ64GA002.h> /* Device include file */
|
||||||
|
#include "pic24f.h"
|
||||||
|
#include "uart.h"
|
||||||
|
|
||||||
|
#define SELECT() _LATB15 = 0 /* CS = L */
|
||||||
|
#define DESELECT() _LATB15 = 1 /* CS = H */
|
||||||
|
#define MMC_SEL !_LATB15 /* CS status (true:CS == L) */
|
||||||
|
#define FORWARD(d) uart_put(d) /* Data forwarding function (Console out in this example) */
|
||||||
|
|
||||||
|
static
|
||||||
|
void init_spi (void) /* Initialize SPI port */
|
||||||
|
{
|
||||||
|
SPI1CON1 = 0x013B;
|
||||||
|
SPI1CON2 = 0x0000;
|
||||||
|
_SPIEN = 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
void dly_100us (void) /* Delay 100 microseconds */
|
||||||
|
{
|
||||||
|
UINT n = FCY / 100000;
|
||||||
|
do {
|
||||||
|
LATA; LATA; LATA; LATA; LATA; LATA;
|
||||||
|
} while (--n);
|
||||||
|
}
|
||||||
|
|
||||||
|
static
|
||||||
|
void xmit_spi (BYTE d) /* Send a byte to the SDC/MMC */
|
||||||
|
{
|
||||||
|
SPI1BUF = d;
|
||||||
|
while (!_SPIRBF) ;
|
||||||
|
SPI1BUF;
|
||||||
|
}
|
||||||
|
|
||||||
|
static
|
||||||
|
BYTE rcv_spi (void) /* Send a 0xFF to the SDC/MMC and get the received byte */
|
||||||
|
{
|
||||||
|
SPI1BUF = 0xFF;
|
||||||
|
while (!_SPIRBF) ;
|
||||||
|
return (BYTE)SPI1BUF;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
/*--------------------------------------------------------------------------
|
||||||
|
|
||||||
|
Module Private Functions
|
||||||
|
|
||||||
|
---------------------------------------------------------------------------*/
|
||||||
|
|
||||||
|
/* Definitions for MMC/SDC command */
|
||||||
|
#define CMD0 (0x40+0) /* GO_IDLE_STATE */
|
||||||
|
#define CMD1 (0x40+1) /* SEND_OP_COND (MMC) */
|
||||||
|
#define ACMD41 (0xC0+41) /* SEND_OP_COND (SDC) */
|
||||||
|
#define CMD8 (0x40+8) /* SEND_IF_COND */
|
||||||
|
#define CMD16 (0x40+16) /* SET_BLOCKLEN */
|
||||||
|
#define CMD17 (0x40+17) /* READ_SINGLE_BLOCK */
|
||||||
|
#define CMD24 (0x40+24) /* WRITE_BLOCK */
|
||||||
|
#define CMD55 (0x40+55) /* APP_CMD */
|
||||||
|
#define CMD58 (0x40+58) /* READ_OCR */
|
||||||
|
|
||||||
|
|
||||||
|
/* Card type flags (CardType) */
|
||||||
|
#define CT_MMC 0x01 /* MMC ver 3 */
|
||||||
|
#define CT_SD1 0x02 /* SD ver 1 */
|
||||||
|
#define CT_SD2 0x04 /* SD ver 2 */
|
||||||
|
#define CT_BLOCK 0x08 /* Block addressing */
|
||||||
|
|
||||||
|
|
||||||
|
static
|
||||||
|
BYTE CardType;
|
||||||
|
|
||||||
|
|
||||||
|
/*-----------------------------------------------------------------------*/
|
||||||
|
/* Send a command packet to the SDC/MMC */
|
||||||
|
/*-----------------------------------------------------------------------*/
|
||||||
|
|
||||||
|
static
|
||||||
|
BYTE send_cmd (
|
||||||
|
BYTE cmd, /* 1st byte (Start + Index) */
|
||||||
|
DWORD arg /* Argument (32 bits) */
|
||||||
|
)
|
||||||
|
{
|
||||||
|
BYTE n, res;
|
||||||
|
|
||||||
|
|
||||||
|
if (cmd & 0x80) { /* ACMD<n> is the command sequense of CMD55-CMD<n> */
|
||||||
|
cmd &= 0x7F;
|
||||||
|
res = send_cmd(CMD55, 0);
|
||||||
|
if (res > 1) return res;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Select the card */
|
||||||
|
DESELECT();
|
||||||
|
rcv_spi();
|
||||||
|
SELECT();
|
||||||
|
rcv_spi();
|
||||||
|
|
||||||
|
/* Send a command packet */
|
||||||
|
xmit_spi(cmd); /* Start + Command index */
|
||||||
|
xmit_spi((BYTE)(arg >> 24)); /* Argument[31..24] */
|
||||||
|
xmit_spi((BYTE)(arg >> 16)); /* Argument[23..16] */
|
||||||
|
xmit_spi((BYTE)(arg >> 8)); /* Argument[15..8] */
|
||||||
|
xmit_spi((BYTE)arg); /* Argument[7..0] */
|
||||||
|
n = 0x01; /* Dummy CRC + Stop */
|
||||||
|
if (cmd == CMD0) n = 0x95; /* Valid CRC for CMD0(0) */
|
||||||
|
if (cmd == CMD8) n = 0x87; /* Valid CRC for CMD8(0x1AA) */
|
||||||
|
xmit_spi(n);
|
||||||
|
|
||||||
|
/* Receive a command response */
|
||||||
|
n = 10; /* Wait for a valid response in timeout of 10 attempts */
|
||||||
|
do {
|
||||||
|
res = rcv_spi();
|
||||||
|
} while ((res & 0x80) && --n);
|
||||||
|
|
||||||
|
return res; /* Return with the response value */
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
/*--------------------------------------------------------------------------
|
||||||
|
|
||||||
|
Public Functions
|
||||||
|
|
||||||
|
---------------------------------------------------------------------------*/
|
||||||
|
|
||||||
|
/*-----------------------------------------------------------------------*/
|
||||||
|
/* Initialize Disk Drive */
|
||||||
|
/*-----------------------------------------------------------------------*/
|
||||||
|
|
||||||
|
DSTATUS disk_initialize (void)
|
||||||
|
{
|
||||||
|
BYTE n, cmd, ty, ocr[4];
|
||||||
|
UINT tmr;
|
||||||
|
|
||||||
|
#if _USE_WRITE
|
||||||
|
if (CardType && MMC_SEL) disk_writep(0, 0); /* Finalize write process if it is in progress */
|
||||||
|
#endif
|
||||||
|
init_spi(); /* Initialize ports to control SDC/MMC */
|
||||||
|
DESELECT();
|
||||||
|
for (n = 10; n; n--) rcv_spi(); /* 80 Dummy clocks with CS=H */
|
||||||
|
|
||||||
|
ty = 0;
|
||||||
|
if (send_cmd(CMD0, 0) == 1) { /* Enter Idle state */
|
||||||
|
if (send_cmd(CMD8, 0x1AA) == 1) { /* SDv2 */
|
||||||
|
for (n = 0; n < 4; n++) ocr[n] = rcv_spi(); /* Get trailing return value of R7 resp */
|
||||||
|
if (ocr[2] == 0x01 && ocr[3] == 0xAA) { /* The card can work at vdd range of 2.7-3.6V */
|
||||||
|
for (tmr = 10000; tmr && send_cmd(ACMD41, 1UL << 30); tmr--) dly_100us(); /* Wait for leaving idle state (ACMD41 with HCS bit) */
|
||||||
|
if (tmr && send_cmd(CMD58, 0) == 0) { /* Check CCS bit in the OCR */
|
||||||
|
for (n = 0; n < 4; n++) ocr[n] = rcv_spi();
|
||||||
|
ty = (ocr[0] & 0x40) ? CT_SD2 | CT_BLOCK : CT_SD2; /* SDv2 (HC or SC) */
|
||||||
|
}
|
||||||
|
}
|
||||||
|
} else { /* SDv1 or MMCv3 */
|
||||||
|
if (send_cmd(ACMD41, 0) <= 1) {
|
||||||
|
ty = CT_SD1; cmd = ACMD41; /* SDv1 */
|
||||||
|
} else {
|
||||||
|
ty = CT_MMC; cmd = CMD1; /* MMCv3 */
|
||||||
|
}
|
||||||
|
for (tmr = 10000; tmr && send_cmd(cmd, 0); tmr--) dly_100us(); /* Wait for leaving idle state */
|
||||||
|
if (!tmr || send_cmd(CMD16, 512) != 0) /* Set R/W block length to 512 */
|
||||||
|
ty = 0;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
CardType = ty;
|
||||||
|
DESELECT();
|
||||||
|
rcv_spi();
|
||||||
|
|
||||||
|
return ty ? 0 : STA_NOINIT;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
/*-----------------------------------------------------------------------*/
|
||||||
|
/* Read partial sector */
|
||||||
|
/*-----------------------------------------------------------------------*/
|
||||||
|
|
||||||
|
DRESULT disk_readp (
|
||||||
|
BYTE *buff, /* Pointer to the read buffer (NULL:Read bytes are forwarded to the stream) */
|
||||||
|
DWORD sector, /* Sector number (LBA) */
|
||||||
|
UINT offset, /* Byte offset to read from (0..511) */
|
||||||
|
UINT count /* Number of bytes to read (ofs + cnt mus be <= 512) */
|
||||||
|
)
|
||||||
|
{
|
||||||
|
DRESULT res;
|
||||||
|
BYTE rc;
|
||||||
|
UINT bc;
|
||||||
|
|
||||||
|
|
||||||
|
if (!(CardType & CT_BLOCK)) sector *= 512; /* Convert to byte address if needed */
|
||||||
|
|
||||||
|
res = RES_ERROR;
|
||||||
|
if (send_cmd(CMD17, sector) == 0) { /* READ_SINGLE_BLOCK */
|
||||||
|
|
||||||
|
bc = 40000;
|
||||||
|
do { /* Wait for data packet */
|
||||||
|
rc = rcv_spi();
|
||||||
|
} while (rc == 0xFF && --bc);
|
||||||
|
|
||||||
|
if (rc == 0xFE) { /* A data packet arrived */
|
||||||
|
bc = 514 - offset - count;
|
||||||
|
|
||||||
|
/* Skip leading bytes */
|
||||||
|
if (offset) {
|
||||||
|
do rcv_spi(); while (--offset);
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Receive a part of the sector */
|
||||||
|
if (buff) { /* Store data to the memory */
|
||||||
|
do {
|
||||||
|
*buff++ = rcv_spi();
|
||||||
|
} while (--count);
|
||||||
|
} else { /* Forward data to the outgoing stream (depends on the project) */
|
||||||
|
do {
|
||||||
|
FORWARD(rcv_spi());
|
||||||
|
} while (--count);
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Skip remaining bytes and CRC */
|
||||||
|
do rcv_spi(); while (--bc);
|
||||||
|
|
||||||
|
res = RES_OK;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
DESELECT();
|
||||||
|
rcv_spi();
|
||||||
|
|
||||||
|
return res;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
/*-----------------------------------------------------------------------*/
|
||||||
|
/* Write partial sector */
|
||||||
|
/*-----------------------------------------------------------------------*/
|
||||||
|
|
||||||
|
#if _USE_WRITE
|
||||||
|
DRESULT disk_writep (
|
||||||
|
const BYTE *buff, /* Pointer to the bytes to be written (NULL:Initiate/Finalize sector write) */
|
||||||
|
DWORD sc /* Number of bytes to send, Sector number (LBA) or zero */
|
||||||
|
)
|
||||||
|
{
|
||||||
|
DRESULT res;
|
||||||
|
UINT bc;
|
||||||
|
static WORD wc;
|
||||||
|
|
||||||
|
res = RES_ERROR;
|
||||||
|
|
||||||
|
if (buff) { /* Send data bytes */
|
||||||
|
bc = (WORD)sc;
|
||||||
|
while (bc && wc) { /* Send data bytes to the card */
|
||||||
|
xmit_spi(*buff++);
|
||||||
|
wc--; bc--;
|
||||||
|
}
|
||||||
|
res = RES_OK;
|
||||||
|
} else {
|
||||||
|
if (sc) { /* Initiate sector write process */
|
||||||
|
if (!(CardType & CT_BLOCK)) sc *= 512; /* Convert to byte address if needed */
|
||||||
|
if (send_cmd(CMD24, sc) == 0) { /* WRITE_SINGLE_BLOCK */
|
||||||
|
xmit_spi(0xFF); xmit_spi(0xFE); /* Data block header */
|
||||||
|
wc = 512; /* Set byte counter */
|
||||||
|
res = RES_OK;
|
||||||
|
}
|
||||||
|
} else { /* Finalize sector write process */
|
||||||
|
bc = wc + 2;
|
||||||
|
while (bc--) xmit_spi(0); /* Fill left bytes and CRC with zeros */
|
||||||
|
if ((rcv_spi() & 0x1F) == 0x05) { /* Receive data resp and wait for end of write process in timeout of 500ms */
|
||||||
|
for (bc = 5000; rcv_spi() != 0xFF && bc; bc--) dly_100us(); /* Wait ready */
|
||||||
|
if (bc) res = RES_OK;
|
||||||
|
}
|
||||||
|
DESELECT();
|
||||||
|
rcv_spi();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
return res;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
Loading…
Reference in New Issue