Add [bootloader_zevero_sd_m1284p_make] bootloader prj
This commit is contained in:
maxxir_w
226
bootloader_zevero_sd_m1284p_make/diskio.c
Normal file
226
bootloader_zevero_sd_m1284p_make/diskio.c
Normal file
@@ -0,0 +1,226 @@
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Low level disk I/O module skeleton for Petit FatFs (C)ChaN, 2014 */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
#include "pff/src/pff.h"
|
||||
#include "pff/src/diskio.h"
|
||||
|
||||
void init_spi (void); /* Initialize SPI port (asmfunc.S) */
|
||||
void deselect (void); /* Select MMC (asmfunc.S) */
|
||||
void select (void); /* Deselect MMC (asmfunc.S) */
|
||||
void xmit_spi (BYTE d); /* Send a byte to the MMC (asmfunc.S) */
|
||||
BYTE rcv_spi (void); /* Send a 0xFF to the MMC and get the received byte (asmfunc.S) */
|
||||
void dly_100us (void); /* Delay 100 microseconds (asmfunc.S) */
|
||||
|
||||
|
||||
|
||||
/*--------------------------------------------------------------------------
|
||||
|
||||
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 */
|
||||
select();
|
||||
|
||||
/* 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)
|
||||
{
|
||||
DSTATUS stat;
|
||||
|
||||
BYTE n, cmd, ty, ocr[4];
|
||||
UINT tmr;
|
||||
|
||||
|
||||
init_spi(); /* Initialize ports to control MMC */
|
||||
for (n = 100; n; n--) dly_100us(); /* 10ms delay */
|
||||
for (n = 10; n; n--) deselect(); /* 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();
|
||||
|
||||
stat = ty ? 0 : STA_NOINIT;
|
||||
|
||||
return stat;
|
||||
}
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Read Partial Sector */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
DRESULT disk_readp (
|
||||
BYTE* buff, /* Pointer to the destination object */
|
||||
DWORD sector, /* Sector number (LBA) */
|
||||
UINT offset, /* Offset in the sector */
|
||||
UINT count /* Byte count (bit15:destination) */
|
||||
)
|
||||
{
|
||||
DRESULT res;
|
||||
BYTE rc;
|
||||
WORD 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 */
|
||||
do {
|
||||
*buff++ = rcv_spi();
|
||||
} while (--count);
|
||||
|
||||
/* Skip trailing bytes and CRC */
|
||||
do rcv_spi(); while (--bc);
|
||||
|
||||
res = RES_OK;
|
||||
}
|
||||
}
|
||||
|
||||
deselect();
|
||||
|
||||
return res;
|
||||
}
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Write Partial Sector */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/*
|
||||
DRESULT disk_writep (
|
||||
const BYTE* buff, // Pointer to the data to be written, NULL:Initiate/Finalize write operation
|
||||
DWORD sc // Sector number (LBA) or Number of bytes to send
|
||||
)
|
||||
{
|
||||
DRESULT res;
|
||||
|
||||
|
||||
if (!buff) {
|
||||
if (sc) {
|
||||
|
||||
// Initiate write process
|
||||
|
||||
} else {
|
||||
|
||||
// Finalize write process
|
||||
|
||||
}
|
||||
} else {
|
||||
|
||||
// Send data to the disk
|
||||
|
||||
}
|
||||
|
||||
return res;
|
||||
}
|
||||
*/
|
||||
Reference in New Issue
Block a user