]>
cloudbase.mooo.com Git - z180-stamp.git/blob - avr/mmc.c
1 /*-----------------------------------------------------------------------*/
2 /* MMCv3/SDv1/SDv2 (in SPI mode) control module (C)ChaN, 2007 */
3 /*-----------------------------------------------------------------------*/
4 /* Only spi_rcvr(), spi_xmit(), disk_timerproc() and some macros */
5 /* are platform dependent. */
6 /*-----------------------------------------------------------------------*/
17 /* Port Controls (Platform dependent) */
18 /* SD card socket connections */
20 /* TODO: config.h cofig macros */
22 //#define SD_CD_0 SBIT(PORT,) /* Card detect switch */
23 //#define SD_CD_0_IN SBIT(PIN,)
24 //#define SD_CD_0_DDR SBIT(DDR,)
26 //#define SD_WP_0 SBIT(PORT,) /* Write protect switch */
27 //#define SD_WP_0_IN SBIT(PIN,)
28 //#define SD_WP_0_DDR SBIT(DDR,)
30 #define SD_CS_0 SBIT(PORTB,0) /* Chip select pin */
31 #define SD_CS_0_IN SBIT(PINB,0)
32 #define SD_CS_0_DDR SBIT(DDRB,0)
35 //#define SD_CD_1 SBIT(PORTG,3) /* Card detect switch */
36 //#define SD_CD_1_IN SBIT(PING,3)
37 //#define SD_CD_1_DDR SBIT(DDRG,3)
39 //#define SD_WP_1 SBIT(PORTG,5) /* Write protect switch */
40 //#define SD_WP_1_IN SBIT(PING,5)
41 //#define SD_WP_1_DDR SBIT(DDRG,5)
43 #define SD_CS_1 SBIT(PORTG,4) /* Chip select pin */
44 #define SD_CS_1_IN SBIT(PING,4)
45 #define SD_CS_1_DDR SBIT(DDRG,4)
48 #define SPI_CLK_SLOW() SPISetMMCInitClock() /* Set slow clock (100k-400k) */
49 #define SPI_CLK_FAST() SPISetFastClock() /* Set fast clock (depends on the CSD) */
51 /*--------------------------------------------------------------------------
52 Definitions for MMC/SDC command
53 ---------------------------------------------------------------------------*/
55 #define CMD0 (0) /* GO_IDLE_STATE */
56 #define CMD1 (1) /* SEND_OP_COND (MMC) */
57 #define ACMD41 (0x80+41) /* SEND_OP_COND (SDC) */
58 #define CMD8 (8) /* SEND_IF_COND */
59 #define CMD9 (9) /* SEND_CSD */
60 #define CMD10 (10) /* SEND_CID */
61 #define CMD12 (12) /* STOP_TRANSMISSION */
62 #define ACMD13 (0x80+13) /* SD_STATUS (SDC) */
63 #define CMD16 (16) /* SET_BLOCKLEN */
64 #define CMD17 (17) /* READ_SINGLE_BLOCK */
65 #define CMD18 (18) /* READ_MULTIPLE_BLOCK */
66 #define CMD23 (23) /* SET_BLOCK_COUNT (MMC) */
67 #define ACMD23 (0x80+23) /* SET_WR_BLK_ERASE_COUNT (SDC) */
68 #define CMD24 (24) /* WRITE_BLOCK */
69 #define CMD25 (25) /* WRITE_MULTIPLE_BLOCK */
70 #define CMD55 (55) /* APP_CMD */
71 #define CMD58 (58) /* READ_OCR */
74 /*--------------------------------------------------------------------------
76 Module Private Functions
78 ---------------------------------------------------------------------------*/
80 struct sdsock_stat_s
{
81 volatile DSTATUS stat
; /* Disk/socket status */
82 BYTE CardType
; /* Card type flags */
92 /*-----------------------------------------------------------------------*/
93 /* Wait for card ready */
94 /*-----------------------------------------------------------------------*/
97 int wait_ready (void) /* 1:OK, 0:Timeout */
99 uint32_t to
= get_timer(0);
101 /* Wait for ready in timeout of 500ms */
103 if (spi_rcvr() == 0xFF) {
106 } while (get_timer(to
) < 500);
111 /*-----------------------------------------------------------------------*/
112 /* Deselect the card and release SPI bus */
113 /*-----------------------------------------------------------------------*/
116 void deselect(BYTE drv
)
118 //debug("*** enter deselect()\n");
125 /* Dummy clock (TODO: force DO hi-z for multiple slave SPI) */
126 if (socket
[drv
].stat
& STA_FAST
)
143 //debug("*** exit deselect()\n");
146 /*-----------------------------------------------------------------------*/
147 /* Select the card and wait for ready */
148 /*-----------------------------------------------------------------------*/
151 int select(BYTE drv
) /* 1:Successful, 0:Timeout */
153 //debug("*** enter select()\n");
164 if (socket
[drv
].stat
& STA_FAST
)
169 /* Dummy clock (force DO enabled) */
173 //debug("*** exit select() == 1\n");
177 //debug("*** exit select() == 0\n");
179 return 0; /* Timeout */
182 /*-----------------------------------------------------------------------*/
183 /* Power Control (Platform dependent) */
184 /*-----------------------------------------------------------------------*/
185 /* When the target system does not support socket power control, there */
186 /* is nothing to do in these functions and chk_power always returns 1. */
189 void power_on(BYTE drv
)
191 //debug("*** enter power_on()\n");
195 SD_PWR_0
= 0; /* Drives PWR pin high */
200 SD_PWR_1
= 0; /* Drives PWR pin high */
203 #if defined SD_PWR_0 || defined SD_PWR_1
204 for (uint32_t to
= get_timer(0); get_timer(to
) < 30;)
205 ; /* Wait for 30ms */
207 //debug("*** exit power_on()\n");
211 void power_off(BYTE drv
)
213 //debug("*** enter power_off()\n");
214 select(drv
); /* Wait for card ready */
219 SD_PWR_0
= 1; /* Socket power OFF */
223 SD_PWR_1
= 1; /* Socket power OFF */
226 socket
[drv
].stat
|= STA_NOINIT
;
227 //debug("*** exit power_off()\n");
232 int chk_power(BYTE drv
) /* Socket power state: 0=off, 1=on */
236 return SD_PWR_0
== 0;
239 #endif /* SD_PWR_PIN */
242 return SD_PWR_1
== 0;
245 #endif /* SD_PWR_PIN */
250 /*-----------------------------------------------------------------------*/
251 /* Receive a data packet from MMC */
252 /*-----------------------------------------------------------------------*/
256 BYTE
*buff
, /* Data buffer to store received data */
257 UINT btr
/* Byte count (must be multiple of 4) */
260 uint32_t to
= get_timer(0);
262 /* Wait for data packet in timeout of 200ms */
265 } while ((token
== 0xFF) && get_timer(to
) < 200);
266 if(token
!= 0xFE) return 0; /* If not valid data token, retutn with error */
268 tmp
= spi_rcvr(); /* shift in first byte */
269 spi_write(0xff); /* start shift in next byte */
272 asm volatile (""::"r"(buff
), "r"(btr
));
277 *buff
= tmp
; /* store last byte in buffer while SPI module shifts in crc part1 */
279 spi_rcvr(); /* second crc */
281 return 1; /* Return with success */
284 /*-----------------------------------------------------------------------*/
285 /* Send a data packet to MMC */
286 /*-----------------------------------------------------------------------*/
291 const BYTE
*buff
, /* 512 byte data block to be transmitted */
292 BYTE token
/* Data/Stop token */
298 if (!wait_ready()) return 0;
300 spi_write(token
); /* Xmit data token */
301 if (token
!= 0xFD) { /* Is data token */
309 spi_xmit(0xff); /* CRC (Dummy) */
311 resp
= spi_rcvr(); /* Reveive data response */
312 return ((resp
& 0x1F) != 0x05) ? 0 : 1; /* If not accepted, return with error */
318 #endif /* _USE_WRITE */
320 /*-----------------------------------------------------------------------*/
321 /* Send a command packet to MMC */
322 /*-----------------------------------------------------------------------*/
325 BYTE
send_cmd ( /* Returns R1 resp (bit7==1:Send failed) */
326 BYTE drv
, /* Physical drive nmuber (0) */
327 BYTE cmd
, /* Command index */
328 DWORD arg
/* Argument */
336 //debug("*** send_cmd( %.2x )\n", cmd);
338 if (cmd
& 0x80) { /* ACMD<n> is the command sequense of CMD55-CMD<n> */
340 res
= send_cmd(drv
, CMD55
, 0);
345 /* Select the card and wait for ready except to stop multiple block read */
352 /* Send command packet */
353 spi_xmit(0x40 | cmd
); /* Start + Command index */
355 spi_xmit(argtmp
.as8
[3]); /* Argument[31..24] */
356 spi_xmit(argtmp
.as8
[2]); /* Argument[23..16] */
357 spi_xmit(argtmp
.as8
[1]); /* Argument[15..8] */
358 spi_xmit(argtmp
.as8
[0]); /* Argument[7..0] */
360 n
= 0x01; /* Dummy CRC + Stop */
362 n
= 0x95; /* Valid CRC for CMD0(0) */
364 n
= 0x87; /* Valid CRC for CMD8(0x1AA) */
367 /* Receive command response */
369 spi_rcvr(); /* Skip a stuff byte when stop reading */
370 n
= 10; /* Wait for a valid response in timeout of 10 attempts */
373 while ((res
& 0x80) && --n
);
375 return res
; /* Return with the response value */
378 /*--------------------------------------------------------------------------
382 ---------------------------------------------------------------------------*/
387 SD_PWR_1
= 1; /* Drives PWR pin low */
388 SD_PWR_0_DDR
= 1; /* Turns on PWR pin as output */
392 SD_WP_0
= 1; /* Pullup */
396 SD_PWR_1
= 1; /* Drives PWR pin low */
397 SD_PWR_1_DDR
= 1; /* Turns on PWR pin as output */
401 SD_WP_1
= 1; /* Pullup */
406 SPI_DDR
= (SPI_DDR
& ~(_BV(SPI_MISO
) | _BV(SPI_SS
)))
407 | _BV(SPI_MOSI
) | _BV(SPI_SCK
);
408 SPI_PORT
= SPI_PORT
& ~(_BV(SPI_MOSI
) | _BV(SPI_SCK
));
413 #elif defined SD_CS_0_IN
424 #elif defined SD_CS_1_IN
433 /*-----------------------------------------------------------------------*/
434 /* Initialize Disk Drive */
435 /*-----------------------------------------------------------------------*/
437 #define MMC_INIT_TO 1000 /* 1s */
439 DSTATUS
disk_initialize (
440 BYTE drv
/* Physical drive nmuber (0) */
443 BYTE n
, cmd
, ty
, ocr
[4];
446 return STA_NOINIT
; /* Supports only single drive */
447 if (socket
[drv
].stat
& STA_NODISK
)
448 return socket
[drv
].stat
; /* No card in the socket */
450 power_on(drv
); /* Force socket power on */
451 socket
[drv
].stat
&= ~STA_FAST
;
454 spi_rcvr(); /* 80 dummy clocks */
457 if (send_cmd(drv
, CMD0
, 0) == 1) { /* Enter Idle state */
458 /* Init timeout timer */
459 uint32_t timer
= get_timer(0);
461 if (send_cmd(drv
, CMD8
, 0x1AA) == 1) { /* SDv2? */
462 /* Get trailing return value of R7 resp */
463 for (n
= 0; n
< 4; n
++)
465 if (ocr
[2] == 0x01 && ocr
[3] == 0xAA) {
466 /* The card can work at vdd range of 2.7-3.6V */
467 while (get_timer(timer
) < MMC_INIT_TO
468 && send_cmd(drv
, ACMD41
, 1UL << 30))
469 ; /* Wait for leaving idle state (ACMD41 with HCS bit) */
470 if (get_timer(timer
) < MMC_INIT_TO
&& send_cmd(drv
, CMD58
, 0) == 0) {
471 /* Check CCS bit in the OCR */
472 for (n
= 0; n
< 4; n
++)
474 ty
= (ocr
[0] & 0x40) ? CT_SD2
| CT_BLOCK
: CT_SD2
; /* SDv2 */
477 } else { /* SDv1 or MMCv3 */
478 if (send_cmd(drv
, ACMD41
, 0) <= 1) {
479 ty
= CT_SD1
; cmd
= ACMD41
; /* SDv1 */
481 ty
= CT_MMC
; cmd
= CMD1
; /* MMCv3 */
484 /* Wait for leaving idle state */
485 while (get_timer(timer
) < MMC_INIT_TO
&& send_cmd(drv
, cmd
, 0))
488 /* Set R/W block length to 512 */
489 if (!(get_timer(timer
) < MMC_INIT_TO
) || send_cmd(drv
, CMD16
, 512) != 0)
493 socket
[drv
].CardType
= ty
;
496 if (ty
) { /* Initialization succeded */
497 /* Clear STA_NOINIT */
498 socket
[drv
].stat
= (socket
[drv
].stat
& ~STA_NOINIT
) | STA_FAST
;
499 } else { /* Initialization failed */
503 return socket
[drv
].stat
;
506 /*-----------------------------------------------------------------------*/
507 /* Get Disk Status */
508 /*-----------------------------------------------------------------------*/
510 DSTATUS
disk_status (
511 BYTE drv
/* Physical drive nmuber (0) */
516 return socket
[drv
].stat
;
519 /*-----------------------------------------------------------------------*/
521 /*-----------------------------------------------------------------------*/
524 BYTE drv
, /* Physical drive nmuber (0) */
525 BYTE
*buff
, /* Pointer to the data buffer to store read data */
526 DWORD sector
, /* Start sector number (LBA) */
527 UINT count
/* Sector count (1..255) */
532 if (drv
>= MAX_DRV
|| !count
)
534 if (socket
[drv
].stat
& STA_NOINIT
)
537 /* Convert to byte address if needed */
538 if (!(socket
[drv
].CardType
& CT_BLOCK
))
541 /* READ_MULTIPLE_BLOCK : READ_SINGLE_BLOCK */
542 cmd
= count
> 1 ? CMD18
: CMD17
;
543 if (send_cmd(drv
, cmd
, sector
) == 0) {
545 if (!rcvr_datablock(buff
, 512))
550 send_cmd(drv
, CMD12
, 0); /* STOP_TRANSMISSION */
554 return count
? RES_ERROR
: RES_OK
;
557 /*-----------------------------------------------------------------------*/
558 /* Write Sector(s) */
559 /*-----------------------------------------------------------------------*/
563 BYTE drv
, /* Physical drive nmuber (0) */
564 const BYTE
*buff
, /* Pointer to the data to be written */
565 DWORD sector
, /* Start sector number (LBA) */
566 UINT count
/* Sector count (1..255) */
569 if (drv
>= MAX_DRV
|| !count
)
571 if (socket
[drv
].stat
& STA_NOINIT
)
573 if (socket
[drv
].stat
& STA_PROTECT
)
576 /* Convert to byte address if needed */
577 if (!(socket
[drv
].CardType
& CT_BLOCK
))
581 /* Single block write */
582 if ((send_cmd(drv
, CMD24
, sector
) == 0) /* WRITE_BLOCK */
583 && xmit_datablock(buff
, 0xFE))
586 /* Multiple block write */
587 if (socket
[drv
].CardType
& CT_SDC
)
588 send_cmd(drv
, ACMD23
, count
);
589 if (send_cmd(drv
, CMD25
, sector
) == 0) {
590 /* WRITE_MULTIPLE_BLOCK */
592 if (!xmit_datablock(buff
, 0xFC))
596 if (!xmit_datablock(0, 0xFD)) /* STOP_TRAN token */
602 return count
? RES_ERROR
: RES_OK
;
604 #endif /* _USE_WRITE */
606 /*-----------------------------------------------------------------------*/
607 /* Miscellaneous Functions */
608 /*-----------------------------------------------------------------------*/
612 BYTE drv
, /* Physical drive nmuber (0) */
613 BYTE cmd
, /* Control code */
614 void *buff
/* Buffer to send/receive control data */
618 BYTE n
, csd
[16], *ptr
= buff
;
626 if (socket
[drv
].stat
& STA_NOINIT
)
629 /* TODO: SPI clock? */
632 case CTRL_SYNC
: /* Make sure that no pending write process. Do not remove this or written sector might not left updated. */
637 case GET_SECTOR_COUNT
: /* Get number of sectors on the disk (DWORD) */
638 if ((send_cmd(drv
, CMD9
, 0) == 0) && rcvr_datablock(csd
, 16)) {
639 if ((csd
[0] >> 6) == 1) { /* SDC ver 2.00 */
640 csize
= csd
[9] + ((WORD
)csd
[8] << 8) + ((DWORD
)(csd
[7] & 63) << 16) + 1;
641 *(DWORD
*)buff
= csize
<< 10;
642 } else { /* SDC ver 1.XX or MMC*/
643 n
= (csd
[5] & 15) + ((csd
[10] & 128) >> 7) + ((csd
[9] & 3) << 1) + 2;
644 csize
= (csd
[8] >> 6) + ((WORD
)csd
[7] << 2) + ((WORD
)(csd
[6] & 3) << 10) + 1;
645 *(DWORD
*)buff
= csize
<< (n
- 9);
651 case GET_BLOCK_SIZE
: /* Get erase block size in unit of sector (DWORD) */
652 if (socket
[drv
].CardType
& CT_SD2
) { /* SDv2? */
653 if (send_cmd(drv
, ACMD13
, 0) == 0) { /* Read SD status */
655 if (rcvr_datablock(csd
, 16)) { /* Read partial block */
656 for (n
= 64 - 16; n
; n
--)
657 spi_rcvr(); /* Purge trailing data */
658 *(DWORD
*) buff
= 16UL << (csd
[10] >> 4);
662 } else { /* SDv1 or MMCv3 */
663 if ((send_cmd(drv
, CMD9
, 0) == 0) && rcvr_datablock(csd
, 16)) { /* Read CSD */
664 if (socket
[drv
].CardType
& CT_SD1
) { /* SDv1 */
665 *(DWORD
*)buff
= (((csd
[10] & 63) << 1) + ((WORD
)(csd
[11] & 128) >> 7) + 1) << ((csd
[13] >> 6) - 1);
667 *(DWORD
*)buff
= ((WORD
)((csd
[10] & 124) >> 2) + 1) * (((csd
[11] & 3) << 3) + ((csd
[11] & 224) >> 5) + 1);
674 /* Following commands are never used by FatFs module */
676 case MMC_GET_TYPE
: /* Get card type flags (1 byte) */
677 *ptr
= socket
[drv
].CardType
;
681 case MMC_GET_CSD
: /* Receive CSD as a data block (16 bytes) */
682 if (send_cmd(drv
, CMD9
, 0) == 0 /* READ_CSD */
683 && rcvr_datablock(ptr
, 16))
687 case MMC_GET_CID
: /* Receive CID as a data block (16 bytes) */
688 if (send_cmd(drv
, CMD10
, 0) == 0 /* READ_CID */
689 && rcvr_datablock(ptr
, 16))
693 case MMC_GET_OCR
: /* Receive OCR as an R3 resp (4 bytes) */
694 if (send_cmd(drv
, CMD58
, 0) == 0) { /* READ_OCR */
701 case MMC_GET_SDSTAT
: /* Receive SD status as a data block (64 bytes) */
702 if (send_cmd(drv
, ACMD13
, 0) == 0) { /* SD_STATUS */
704 if (rcvr_datablock(ptr
, 64))
709 case CTRL_POWER_OFF
: /* Power off */
711 socket
[drv
].stat
|= STA_NOINIT
;
723 #endif /* _USE_IOCTL */
725 /*-----------------------------------------------------------------------*/
726 /* Device Timer Interrupt Procedure (Platform dependent) */
727 /*-----------------------------------------------------------------------*/
728 /* This function must be called in period of 10ms */
730 void disk_timerproc (void)
736 if (SD_WP_0_IN
== 0) /* Write protected */
738 else /* Write enabled */
743 if (SD_CD_0_IN
== 0) /* Card inserted */
745 else /* Socket empty */
746 s
|= (STA_NODISK
| STA_NOINIT
);
747 #elif defined SD_CS_0_IN
748 if (SD_CS_0_DDR
== 0) {
749 if (SD_CS_0_IN
== 1) /* Card inserted */
751 else /* Socket empty */
752 s
|= (STA_NODISK
| STA_NOINIT
);
755 socket
[0].stat
= s
; /* Update MMC status */
759 if (SD_WP_1_IN
== 0) /* Write protected */
761 else /* Write enabled */
766 if (SD_CD_1_IN
== 0) /* Card inserted */
768 else /* Socket empty */
769 s
|= (STA_NODISK
| STA_NOINIT
);
770 #elif defined SD_CS_1_IN
771 if (SD_CS_1_DDR
== 0) {
772 if (SD_CS_1_IN
== 1) /* Card inserted */
774 else /* Socket empty */
775 s
|= (STA_NODISK
| STA_NOINIT
);
778 socket
[1].stat
= s
; /* Update MMC status */