git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@85 35acf78f-673a-0410-8e92-d51de3d6d3f4
This commit is contained in:
parent
8b1e399085
commit
48cdf91217
|
@ -83,8 +83,9 @@ static void InsertHandler(t_eventid id) {
|
||||||
/* Card ready, do stuff.*/
|
/* Card ready, do stuff.*/
|
||||||
if (mmcGetSize(&data))
|
if (mmcGetSize(&data))
|
||||||
return;
|
return;
|
||||||
if (mmcBlockRead(0x200000, rwbuf))
|
if (mmcRead(rwbuf, 0))
|
||||||
return;
|
return;
|
||||||
|
PlaySound(440, 200);
|
||||||
}
|
}
|
||||||
|
|
||||||
static void RemoveHandler(t_eventid id) {
|
static void RemoveHandler(t_eventid id) {
|
||||||
|
|
|
@ -58,6 +58,9 @@ void tmrfunc(void *par) {
|
||||||
chVTSetI(&vt, 10, tmrfunc, NULL);
|
chVTSetI(&vt, 10, tmrfunc, NULL);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Starts the card polling service.
|
||||||
|
*/
|
||||||
void mmcStartPolling(void) {
|
void mmcStartPolling(void) {
|
||||||
|
|
||||||
chSysLock();
|
chSysLock();
|
||||||
|
@ -70,6 +73,9 @@ void mmcStartPolling(void) {
|
||||||
chSysUnlock();
|
chSysUnlock();
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Stops the card polling service.
|
||||||
|
*/
|
||||||
void mmcStopPolling(void) {
|
void mmcStopPolling(void) {
|
||||||
|
|
||||||
chSysLock();
|
chSysLock();
|
||||||
|
@ -82,17 +88,24 @@ void mmcStopPolling(void) {
|
||||||
chSysUnlock();
|
chSysUnlock();
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Returns TRUE if the card is safely inserted in the reader.
|
||||||
|
*/
|
||||||
BOOL mmcCardInserted (void) {
|
BOOL mmcCardInserted (void) {
|
||||||
|
|
||||||
return cnt == 0;
|
return cnt == 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
static void sendhdr(BYTE8 cmd, ULONG32 arg) {
|
static void wait(void) {
|
||||||
BYTE8 buf[6];
|
int i;
|
||||||
|
BYTE8 buf[4];
|
||||||
|
|
||||||
/*
|
for (i = 0; i < 16; i++) {
|
||||||
* Wait for the bus to become idle if a write operation was in progress.
|
sspRW(buf, NULL, 1);
|
||||||
*/
|
if (buf[0] == 0xFF)
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
/* Looks like it is a loooong wait.*/
|
||||||
while (TRUE) {
|
while (TRUE) {
|
||||||
sspRW(buf, NULL, 1);
|
sspRW(buf, NULL, 1);
|
||||||
if (buf[0] == 0xFF)
|
if (buf[0] == 0xFF)
|
||||||
|
@ -101,6 +114,15 @@ static void sendhdr(BYTE8 cmd, ULONG32 arg) {
|
||||||
chThdSleep(1); /* Trying to be nice with the other threads.*/
|
chThdSleep(1); /* Trying to be nice with the other threads.*/
|
||||||
#endif
|
#endif
|
||||||
}
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static void sendhdr(BYTE8 cmd, ULONG32 arg) {
|
||||||
|
BYTE8 buf[6];
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Wait for the bus to become idle if a write operation was in progress.
|
||||||
|
*/
|
||||||
|
wait();
|
||||||
|
|
||||||
buf[0] = 0x40 | cmd;
|
buf[0] = 0x40 | cmd;
|
||||||
buf[1] = arg >> 24;
|
buf[1] = arg >> 24;
|
||||||
|
@ -228,7 +250,7 @@ BOOL mmcGetSize(MMCCSD *data) {
|
||||||
* @param buf the pointer to the read buffer
|
* @param buf the pointer to the read buffer
|
||||||
* @return \p TRUE if an error happened
|
* @return \p TRUE if an error happened
|
||||||
*/
|
*/
|
||||||
BOOL mmcBlockRead(ULONG32 blknum, BYTE8 *buf) {
|
BOOL mmcRead(BYTE8 *buf, ULONG32 blknum) {
|
||||||
|
|
||||||
sspAcquireBus();
|
sspAcquireBus();
|
||||||
sendhdr(CMDREAD, blknum << 8);
|
sendhdr(CMDREAD, blknum << 8);
|
||||||
|
@ -244,6 +266,39 @@ BOOL mmcBlockRead(ULONG32 blknum, BYTE8 *buf) {
|
||||||
return FALSE;
|
return FALSE;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Reads multiple blocks.
|
||||||
|
* @param blknum the initial block
|
||||||
|
* @param n the number of blocks
|
||||||
|
* @param buf the pointer to the read buffer
|
||||||
|
* @return \p TRUE if an error happened
|
||||||
|
*/
|
||||||
|
BOOL mmcReadMultiple(BYTE8 *buf, ULONG32 blknum, ULONG32 n) {
|
||||||
|
static const BYTE8 stopcmd[] = {0x40 | CMDSTOP, 0, 0, 0, 0, 1, 0xFF};
|
||||||
|
|
||||||
|
sspAcquireBus();
|
||||||
|
sendhdr(CMDREADMULTIPLE, blknum << 8);
|
||||||
|
if (recvr1() != 0x00) {
|
||||||
|
sspReleaseBus();
|
||||||
|
return TRUE;
|
||||||
|
}
|
||||||
|
while (n) {
|
||||||
|
if (getdata(buf, 512)) {
|
||||||
|
sspReleaseBus();
|
||||||
|
return TRUE;
|
||||||
|
}
|
||||||
|
buf += 512;
|
||||||
|
n--;
|
||||||
|
}
|
||||||
|
sspRW(NULL, (BYTE8 *)stopcmd, sizeof(stopcmd));
|
||||||
|
if (recvr1() != 0x00) {
|
||||||
|
sspReleaseBus();
|
||||||
|
return TRUE;
|
||||||
|
}
|
||||||
|
sspReleaseBus();
|
||||||
|
return FALSE;
|
||||||
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Writes a block.
|
* Writes a block.
|
||||||
* @param blknum the block number
|
* @param blknum the block number
|
||||||
|
@ -254,8 +309,8 @@ BOOL mmcBlockRead(ULONG32 blknum, BYTE8 *buf) {
|
||||||
* the card, this allows to not make useless busy waiting. The invoking
|
* the card, this allows to not make useless busy waiting. The invoking
|
||||||
* thread can do other things while the data is being written.
|
* thread can do other things while the data is being written.
|
||||||
*/
|
*/
|
||||||
BOOL mmcBlockWrite(ULONG32 blknum, BYTE8 *buf) {
|
BOOL mmcWrite(BYTE8 *buf, ULONG32 blknum) {
|
||||||
static BYTE8 start[] = {0xFF, 0xFE};
|
static const BYTE8 start[] = {0xFF, 0xFE};
|
||||||
BYTE8 b[4];
|
BYTE8 b[4];
|
||||||
|
|
||||||
sspAcquireBus();
|
sspAcquireBus();
|
||||||
|
@ -264,16 +319,56 @@ BOOL mmcBlockWrite(ULONG32 blknum, BYTE8 *buf) {
|
||||||
sspReleaseBus();
|
sspReleaseBus();
|
||||||
return TRUE;
|
return TRUE;
|
||||||
}
|
}
|
||||||
sspRW(NULL, start, 2); /* Data prologue.*/
|
sspRW(NULL, (BYTE8 *)start, 2); /* Data prologue.*/
|
||||||
sspRW(NULL, buf, 512); /* Data.*/
|
sspRW(NULL, buf, 512); /* Data.*/
|
||||||
sspRW(NULL, NULL, 2); /* CRC ignored in this version.*/
|
sspRW(NULL, NULL, 2); /* CRC ignored in this version.*/
|
||||||
sspRW(b, NULL, 1);
|
sspRW(b, NULL, 1);
|
||||||
sspReleaseBus();
|
sspReleaseBus();
|
||||||
if ((b[0] & 0x1E) != 0x05)
|
if ((b[0] & 0x1F) != 0x05)
|
||||||
return TRUE;
|
return TRUE;
|
||||||
return FALSE;
|
return FALSE;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Writes multiple blocks.
|
||||||
|
* @param blknum the initial block
|
||||||
|
* @param n the number of blocks
|
||||||
|
* @param buf the pointer to the write buffer
|
||||||
|
* @return \p TRUE if an error happened
|
||||||
|
* @note The function DOES NOT wait for the SPI bus to become free after
|
||||||
|
* sending the data, the bus check is done before sending commands to
|
||||||
|
* the card, this allows to not make useless busy waiting. The invoking
|
||||||
|
* thread can do other things while the data is being written.
|
||||||
|
*/
|
||||||
|
BOOL mmcWriteMultiple(BYTE8 *buf, ULONG32 blknum, ULONG32 n) {
|
||||||
|
static const BYTE8 start[] = {0xFF, 0xFC},
|
||||||
|
stop[] = {0xFD, 0xFF};
|
||||||
|
BYTE8 b[4];
|
||||||
|
|
||||||
|
sspAcquireBus();
|
||||||
|
sendhdr(CMDWRITEMULTIPLE, blknum << 8);
|
||||||
|
if (recvr1() != 0x00) {
|
||||||
|
sspReleaseBus();
|
||||||
|
return TRUE;
|
||||||
|
}
|
||||||
|
while (n) {
|
||||||
|
sspRW(NULL, (BYTE8 *)start, sizeof(start)); /* Data prologue.*/
|
||||||
|
sspRW(NULL, buf, 512); /* Data.*/
|
||||||
|
sspRW(NULL, NULL, 2); /* CRC ignored in this version.*/
|
||||||
|
sspRW(b, NULL, 1);
|
||||||
|
if ((b[0] & 0x1F) != 0x05) {
|
||||||
|
sspReleaseBus();
|
||||||
|
return TRUE;
|
||||||
|
}
|
||||||
|
wait();
|
||||||
|
buf += 512;
|
||||||
|
n--;
|
||||||
|
}
|
||||||
|
sspRW(NULL, (BYTE8 *)stop, sizeof(stop)); /* Stops the transfer.*/
|
||||||
|
sspReleaseBus();
|
||||||
|
return FALSE;
|
||||||
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Makes sure that pending operations are completed before returning.
|
* Makes sure that pending operations are completed before returning.
|
||||||
*/
|
*/
|
||||||
|
|
|
@ -22,19 +22,19 @@
|
||||||
|
|
||||||
#define NICE_WAITING
|
#define NICE_WAITING
|
||||||
|
|
||||||
/* Following times are 10mS units.*/
|
|
||||||
#define CMD0_RETRY 10
|
#define CMD0_RETRY 10
|
||||||
#define CMD1_RETRY 100
|
#define CMD1_RETRY 100
|
||||||
#define POLLING_INTERVAL 10
|
#define POLLING_INTERVAL 10
|
||||||
|
|
||||||
/* Byte transfer time units.*/
|
|
||||||
#define MMC_WAIT_DATA 10000
|
#define MMC_WAIT_DATA 10000
|
||||||
|
|
||||||
#define CMDGOIDLE 0
|
#define CMDGOIDLE 0
|
||||||
#define CMDINIT 1
|
#define CMDINIT 1
|
||||||
#define CMDREADCSD 9
|
#define CMDREADCSD 9
|
||||||
|
#define CMDSTOP 12
|
||||||
#define CMDREAD 17
|
#define CMDREAD 17
|
||||||
|
#define CMDREADMULTIPLE 18
|
||||||
#define CMDWRITE 24
|
#define CMDWRITE 24
|
||||||
|
#define CMDWRITEMULTIPLE 25
|
||||||
|
|
||||||
typedef struct {
|
typedef struct {
|
||||||
ULONG32 csize;
|
ULONG32 csize;
|
||||||
|
@ -51,8 +51,10 @@ void mmcStopPolling(void);
|
||||||
BOOL mmcCardInserted (void);
|
BOOL mmcCardInserted (void);
|
||||||
BYTE8 mmcSendCommand(BYTE8 cmd, ULONG32 arg);
|
BYTE8 mmcSendCommand(BYTE8 cmd, ULONG32 arg);
|
||||||
BOOL mmcGetSize(MMCCSD *data);
|
BOOL mmcGetSize(MMCCSD *data);
|
||||||
BOOL mmcBlockRead(ULONG32 blknum, BYTE8 *buf);
|
BOOL mmcRead(BYTE8 *buf, ULONG32 blknum);
|
||||||
BOOL mmcBlockWrite(ULONG32 blknum, BYTE8 *buf);
|
BOOL mmcReadMultiple(BYTE8 *buf, ULONG32 blknum, ULONG32 n);
|
||||||
|
BOOL mmcWrite(BYTE8 *buf, ULONG32 blknum);
|
||||||
|
BOOL mmcWriteMultiple(BYTE8 *buf, ULONG32 blknum, ULONG32 n);
|
||||||
void mmcSynch(void);
|
void mmcSynch(void);
|
||||||
|
|
||||||
#endif /* _MMCSD_H_*/
|
#endif /* _MMCSD_H_*/
|
||||||
|
|
Loading…
Reference in New Issue