git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@85 35acf78f-673a-0410-8e92-d51de3d6d3f4

This commit is contained in:
gdisirio 2007-11-04 12:43:01 +00:00
parent 8b1e399085
commit 48cdf91217
3 changed files with 116 additions and 18 deletions

View File

@ -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) {

View File

@ -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.
*/ */

View File

@ -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_*/