]>
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 /*-----------------------------------------------------------------------*/
10 #include <util/atomic.h>
18 /* Port Controls (Platform dependent) */
19 /* SD card socket connections */
21 /* TODO: config.h cofig macros */
23 //#define SD_CD_0 SBIT(PORT,) /* Card detect switch */
24 //#define SD_CD_0_IN SBIT(PIN,)
25 //#define SD_CD_0_DDR SBIT(DDR,)
27 //#define SD_WP_0 SBIT(PORT,) /* Write protect switch */
28 //#define SD_WP_0_IN SBIT(PIN,)
29 //#define SD_WP_0_DDR SBIT(DDR,)
31 #define SD_CS_0 SBIT(PORTB,0) /* Chip select/Card sense pin */
32 //#define SD_CS_0_IN SBIT(PINB,0)
33 #define SD_CS_0_DDR SBIT(DDRB,0)
36 #define SD_CD_1 SBIT(PORTG,3) /* Card detect switch */
37 #define SD_CD_1_IN SBIT(PING,3)
38 #define SD_CD_1_DDR SBIT(DDRG,3)
40 //#define SD_WP_1 SBIT(PORTG,5) /* Write protect switch */
41 //#define SD_WP_1_IN SBIT(PING,5)
42 //#define SD_WP_1_DDR SBIT(DDRG,5)
44 #define SD_CS_1 SBIT(PORTG,4) /* Chip select/Card sense pin */
45 //#define SD_CS_1_IN SBIT(PING,4)
46 #define SD_CS_1_DDR SBIT(DDRG,4)
49 #define SPI_CLK_SLOW() SPISetMMCInitClock() /* Set slow clock (100k-400k) */
50 #define SPI_CLK_FAST() SPISetFastClock() /* Set fast clock (depends on the CSD) */
52 /*--------------------------------------------------------------------------
53 Definitions for MMC/SDC command
54 ---------------------------------------------------------------------------*/
56 #define CMD0 (0) /* GO_IDLE_STATE */
57 #define CMD1 (1) /* SEND_OP_COND (MMC) */
58 #define ACMD41 (0x80+41) /* SEND_OP_COND (SDC) */
59 #define CMD8 (8) /* SEND_IF_COND */
60 #define CMD9 (9) /* SEND_CSD */
61 #define CMD10 (10) /* SEND_CID */
62 #define CMD12 (12) /* STOP_TRANSMISSION */
63 #define ACMD13 (0x80+13) /* SD_STATUS (SDC) */
64 #define CMD16 (16) /* SET_BLOCKLEN */
65 #define CMD17 (17) /* READ_SINGLE_BLOCK */
66 #define CMD18 (18) /* READ_MULTIPLE_BLOCK */
67 #define CMD23 (23) /* SET_BLOCK_COUNT (MMC) */
68 #define ACMD23 (0x80+23) /* SET_WR_BLK_ERASE_COUNT (SDC) */
69 #define CMD24 (24) /* WRITE_BLOCK */
70 #define CMD25 (25) /* WRITE_MULTIPLE_BLOCK */
71 #define CMD55 (55) /* APP_CMD */
72 #define CMD58 (58) /* READ_OCR */
75 /*--------------------------------------------------------------------------
77 Module Private Functions
79 ---------------------------------------------------------------------------*/
81 struct sdsock_stat_s
{
82 volatile DSTATUS stat
; /* Disk/socket status */
83 BYTE CardType
; /* Card type flags */
93 /*-----------------------------------------------------------------------*/
94 /* Wait for card ready */
95 /*-----------------------------------------------------------------------*/
98 int wait_ready (void) /* 1:OK, 0:Timeout */
100 uint32_t to
= get_timer(0);
102 /* Wait for ready in timeout of 500ms */
104 if (spi_rcvr() == 0xFF) {
107 } while (get_timer(to
) < 500);
112 /*-----------------------------------------------------------------------*/
113 /* Deselect the card and release SPI bus */
114 /*-----------------------------------------------------------------------*/
117 void deselect(BYTE drv
)
119 //debug("*** enter deselect(%.2x)\n", drv);
126 /* Dummy clock (TODO: force DO hi-z for multiple slave SPI) */
127 if (socket
[drv
].stat
& STA_FAST
)
136 SD_CS_0_DDR
= 0; /* Input */
137 SD_CS_0
= 0; /* No Pullup */
145 //debug("*** exit deselect(%.2x)\n", drv);
148 /*-----------------------------------------------------------------------*/
149 /* Select the card and wait for ready */
150 /*-----------------------------------------------------------------------*/
153 int select(BYTE drv
) /* 1:Successful, 0:Timeout */
155 //debug("*** enter select(%.2x)\n", drv);
170 if (socket
[drv
].stat
& STA_FAST
)
175 /* Dummy clock (force DO enabled) */
179 //debug("*** exit select() == 1\n");
183 //debug("*** exit select() == 0\n");
185 return 0; /* Timeout */
188 /*-----------------------------------------------------------------------*/
189 /* Power Control (Platform dependent) */
190 /*-----------------------------------------------------------------------*/
191 /* When the target system does not support socket power control, there */
192 /* is nothing to do in these functions and chk_power always returns 1. */
195 void power_on(BYTE drv
)
197 //debug("*** enter power_on(%.2x)\n", drv);
201 SD_PWR_0
= 0; /* Drives PWR pin high */
206 SD_PWR_1
= 0; /* Drives PWR pin high */
209 #if defined SD_PWR_0 || defined SD_PWR_1
210 for (uint32_t to
= get_timer(0); get_timer(to
) < 30;)
211 ; /* Wait for 30ms */
213 //debug("*** exit power_on(%.2x)\n", drv);
217 void power_off(BYTE drv
)
219 //debug("*** enter power_off(%.2x)\n", drv);
220 select(drv
); /* Wait for card ready */
225 SD_PWR_0
= 1; /* Socket power OFF */
229 SD_PWR_1
= 1; /* Socket power OFF */
232 ATOMIC_BLOCK(ATOMIC_FORCEON
) {
233 socket
[drv
].stat
|= STA_NOINIT
;
235 //debug("*** exit power_off(%.2x)\n", drv);
240 int chk_power(BYTE drv
) /* Socket power state: 0=off, 1=on */
244 return SD_PWR_0
== 0;
247 #endif /* SD_PWR_PIN */
250 return SD_PWR_1
== 0;
253 #endif /* SD_PWR_PIN */
258 /*-----------------------------------------------------------------------*/
259 /* Receive a data packet from MMC */
260 /*-----------------------------------------------------------------------*/
264 BYTE
*buff
, /* Data buffer to store received data */
265 UINT btr
/* Byte count (must be multiple of 4) */
268 uint32_t to
= get_timer(0);
270 /* Wait for data packet in timeout of 200ms */
273 } while ((token
== 0xFF) && get_timer(to
) < 200);
274 if(token
!= 0xFE) return 0; /* If not valid data token, retutn with error */
276 tmp
= spi_rcvr(); /* shift in first byte */
277 spi_write(0xff); /* start shift in next byte */
280 asm volatile (""::"r"(buff
), "r"(btr
));
285 *buff
= tmp
; /* store last byte in buffer while SPI module shifts in crc part1 */
287 spi_rcvr(); /* second crc */
289 return 1; /* Return with success */
292 /*-----------------------------------------------------------------------*/
293 /* Send a data packet to MMC */
294 /*-----------------------------------------------------------------------*/
299 const BYTE
*buff
, /* 512 byte data block to be transmitted */
300 BYTE token
/* Data/Stop token */
306 if (!wait_ready()) return 0;
308 spi_write(token
); /* Xmit data token */
309 if (token
!= 0xFD) { /* Is data token */
317 spi_xmit(0xff); /* CRC (Dummy) */
319 resp
= spi_rcvr(); /* Reveive data response */
320 return ((resp
& 0x1F) != 0x05) ? 0 : 1; /* If not accepted, return with error */
326 #endif /* _USE_WRITE */
328 /*-----------------------------------------------------------------------*/
329 /* Send a command packet to MMC */
330 /*-----------------------------------------------------------------------*/
333 BYTE
send_cmd ( /* Returns R1 resp (bit7==1:Send failed) */
334 BYTE drv
, /* Physical drive nmuber (0) */
335 BYTE cmd
, /* Command index */
336 DWORD arg
/* Argument */
344 if (cmd
& 0x80) { /* ACMD<n> is the command sequense of CMD55-CMD<n> */
346 res
= send_cmd(drv
, CMD55
, 0);
351 //debug("*** send_cmd( %.2x )", cmd);
353 /* Select the card and wait for ready except to stop multiple block read */
357 //debug(" == %.2x\n", 0xff);
362 /* Send command packet */
363 spi_xmit(0x40 | cmd
); /* Start + Command index */
365 spi_xmit(argtmp
.as8
[3]); /* Argument[31..24] */
366 spi_xmit(argtmp
.as8
[2]); /* Argument[23..16] */
367 spi_xmit(argtmp
.as8
[1]); /* Argument[15..8] */
368 spi_xmit(argtmp
.as8
[0]); /* Argument[7..0] */
370 n
= 0x01; /* Dummy CRC + Stop */
372 n
= 0x95; /* Valid CRC for CMD0(0) */
374 n
= 0x87; /* Valid CRC for CMD8(0x1AA) */
377 /* Receive command response */
379 spi_rcvr(); /* Skip a stuff byte when stop reading */
380 n
= 10; /* Wait for a valid response in timeout of 10 attempts */
383 while ((res
& 0x80) && --n
);
385 //debug(" == %.2x\n", res);
386 return res
; /* Return with the response value */
389 /*--------------------------------------------------------------------------
393 ---------------------------------------------------------------------------*/
398 SD_PWR_1
= 1; /* Drives PWR pin low */
399 SD_PWR_0_DDR
= 1; /* Turns on PWR pin as output */
403 SD_WP_0
= 1; /* Pullup */
407 SD_PWR_1
= 1; /* Drives PWR pin low */
408 SD_PWR_1_DDR
= 1; /* Turns on PWR pin as output */
412 SD_WP_1
= 1; /* Pullup */
417 SPI_DDR
= (SPI_DDR
& ~(_BV(SPI_MISO
) | _BV(SPI_SS
)))
418 | _BV(SPI_MOSI
) | _BV(SPI_SCK
);
419 SPI_PORT
= SPI_PORT
& ~(_BV(SPI_MOSI
) | _BV(SPI_SCK
));
423 SD_CD_0
= 1; /* Pullup */
424 #elif defined SD_CS_0_IN
428 #if defined SD_CD_0 || !defined SD_CS_0_IN
435 SD_CD_1
= 1; /* Pullup */
436 #elif defined SD_CS_1_IN
438 SD_CS_1
= 0; /* No Pullup */
440 #if defined SD_CD_1 || !defined SD_CS_1_IN
441 SD_CS_1
= 1; /* Set High */
446 /*-----------------------------------------------------------------------*/
447 /* Initialize Disk Drive */
448 /*-----------------------------------------------------------------------*/
450 #define MMC_INIT_TO 1000 /* 1s */
452 DSTATUS
disk_initialize (
453 BYTE drv
/* Physical drive nmuber (0) */
456 BYTE n
, cmd
, ty
, ocr
[4];
461 res
= socket
[drv
].stat
;
462 if (res
& STA_NODISK
) {
463 return res
& STAT_MASK
; /* No card in the socket */
465 power_on(drv
); /* Force socket power on */
466 ATOMIC_BLOCK(ATOMIC_FORCEON
) {
467 socket
[drv
].stat
&= ~STA_FAST
;
471 spi_rcvr(); /* 80 dummy clocks */
474 if (send_cmd(drv
, CMD0
, 0) == 1) { /* Enter Idle state */
475 /* Init timeout timer */
476 uint32_t timer
= get_timer(0);
478 if (send_cmd(drv
, CMD8
, 0x1AA) == 1) { /* SDv2? */
479 /* Get trailing return value of R7 resp */
480 for (n
= 0; n
< 4; n
++)
482 if (ocr
[2] == 0x01 && ocr
[3] == 0xAA) {
483 /* The card can work at vdd range of 2.7-3.6V */
484 while (get_timer(timer
) < MMC_INIT_TO
485 && send_cmd(drv
, ACMD41
, 1UL << 30))
486 ; /* Wait for leaving idle state (ACMD41 with HCS bit) */
487 if (get_timer(timer
) < MMC_INIT_TO
&& send_cmd(drv
, CMD58
, 0) == 0) {
488 /* Check CCS bit in the OCR */
489 for (n
= 0; n
< 4; n
++)
491 ty
= (ocr
[0] & 0x40) ? CT_SD2
| CT_BLOCK
: CT_SD2
; /* SDv2 */
494 } else { /* SDv1 or MMCv3 */
495 if (send_cmd(drv
, ACMD41
, 0) <= 1) {
496 ty
= CT_SD1
; cmd
= ACMD41
; /* SDv1 */
498 ty
= CT_MMC
; cmd
= CMD1
; /* MMCv3 */
501 /* Wait for leaving idle state */
502 while (get_timer(timer
) < MMC_INIT_TO
&& send_cmd(drv
, cmd
, 0))
505 /* Set R/W block length to 512 */
506 if (!(get_timer(timer
) < MMC_INIT_TO
) || send_cmd(drv
, CMD16
, 512) != 0)
510 socket
[drv
].CardType
= ty
;
513 if (ty
) { /* Initialization succeded */
514 /* Clear STA_NOINIT */
515 ATOMIC_BLOCK(ATOMIC_FORCEON
) {
516 res
= (socket
[drv
].stat
& ~STA_NOINIT
) | STA_FAST
;
517 socket
[drv
].stat
= res
;
519 } else { /* Initialization failed */
523 return socket
[drv
].stat
& STAT_MASK
;
526 /*-----------------------------------------------------------------------*/
527 /* Get Disk Status */
528 /*-----------------------------------------------------------------------*/
530 DSTATUS
disk_status (
531 BYTE drv
/* Physical drive nmuber (0) */
536 //debug("***** disk_status(%.2x)", drv);
540 res
= socket
[drv
].stat
& STAT_MASK
;
542 //debug(" == %.2x\n", res);
546 /*-----------------------------------------------------------------------*/
548 /*-----------------------------------------------------------------------*/
551 BYTE drv
, /* Physical drive nmuber (0) */
552 BYTE
*buff
, /* Pointer to the data buffer to store read data */
553 DWORD sector
, /* Start sector number (LBA) */
554 UINT count
/* Sector count (1..255) */
559 if (drv
>= MAX_DRV
|| !count
)
561 if (socket
[drv
].stat
& STA_NOINIT
)
564 /* Convert to byte address if needed */
565 if (!(socket
[drv
].CardType
& CT_BLOCK
))
568 /* READ_MULTIPLE_BLOCK : READ_SINGLE_BLOCK */
569 cmd
= count
> 1 ? CMD18
: CMD17
;
570 if (send_cmd(drv
, cmd
, sector
) == 0) {
572 if (!rcvr_datablock(buff
, 512))
577 send_cmd(drv
, CMD12
, 0); /* STOP_TRANSMISSION */
581 return count
? RES_ERROR
: RES_OK
;
584 /*-----------------------------------------------------------------------*/
585 /* Write Sector(s) */
586 /*-----------------------------------------------------------------------*/
590 BYTE drv
, /* Physical drive nmuber (0) */
591 const BYTE
*buff
, /* Pointer to the data to be written */
592 DWORD sector
, /* Start sector number (LBA) */
593 UINT count
/* Sector count (1..255) */
598 if (drv
>= MAX_DRV
|| !count
)
600 res
= socket
[drv
].stat
;
601 if ( res
& STA_NOINIT
)
603 if (res
& STA_PROTECT
)
606 /* Convert to byte address if needed */
607 if (!(socket
[drv
].CardType
& CT_BLOCK
))
611 /* Single block write */
612 if ((send_cmd(drv
, CMD24
, sector
) == 0) /* WRITE_BLOCK */
613 && xmit_datablock(buff
, 0xFE))
616 /* Multiple block write */
617 if (socket
[drv
].CardType
& CT_SDC
)
618 send_cmd(drv
, ACMD23
, count
);
619 if (send_cmd(drv
, CMD25
, sector
) == 0) {
620 /* WRITE_MULTIPLE_BLOCK */
622 if (!xmit_datablock(buff
, 0xFC))
626 if (!xmit_datablock(0, 0xFD)) /* STOP_TRAN token */
632 return count
? RES_ERROR
: RES_OK
;
634 #endif /* _USE_WRITE */
636 /*-----------------------------------------------------------------------*/
637 /* Miscellaneous Functions */
638 /*-----------------------------------------------------------------------*/
642 BYTE drv
, /* Physical drive nmuber (0) */
643 BYTE cmd
, /* Control code */
644 void *buff
/* Buffer to send/receive control data */
648 BYTE n
, csd
[16], *ptr
= buff
;
656 if (socket
[drv
].stat
& STA_NOINIT
)
659 /* TODO: SPI clock? */
662 case CTRL_SYNC
: /* Make sure that no pending write process. Do not remove this or written sector might not left updated. */
667 case GET_SECTOR_COUNT
: /* Get number of sectors on the disk (DWORD) */
668 if ((send_cmd(drv
, CMD9
, 0) == 0) && rcvr_datablock(csd
, 16)) {
669 if ((csd
[0] >> 6) == 1) { /* SDC ver 2.00 */
670 csize
= csd
[9] + ((WORD
)csd
[8] << 8) + ((DWORD
)(csd
[7] & 63) << 16) + 1;
671 *(DWORD
*)buff
= csize
<< 10;
672 } else { /* SDC ver 1.XX or MMC*/
673 n
= (csd
[5] & 15) + ((csd
[10] & 128) >> 7) + ((csd
[9] & 3) << 1) + 2;
674 csize
= (csd
[8] >> 6) + ((WORD
)csd
[7] << 2) + ((WORD
)(csd
[6] & 3) << 10) + 1;
675 *(DWORD
*)buff
= csize
<< (n
- 9);
681 case GET_BLOCK_SIZE
: /* Get erase block size in unit of sector (DWORD) */
682 if (socket
[drv
].CardType
& CT_SD2
) { /* SDv2? */
683 if (send_cmd(drv
, ACMD13
, 0) == 0) { /* Read SD status */
685 if (rcvr_datablock(csd
, 16)) { /* Read partial block */
686 for (n
= 64 - 16; n
; n
--)
687 spi_rcvr(); /* Purge trailing data */
688 *(DWORD
*) buff
= 16UL << (csd
[10] >> 4);
692 } else { /* SDv1 or MMCv3 */
693 if ((send_cmd(drv
, CMD9
, 0) == 0) && rcvr_datablock(csd
, 16)) { /* Read CSD */
694 if (socket
[drv
].CardType
& CT_SD1
) { /* SDv1 */
695 *(DWORD
*)buff
= (((csd
[10] & 63) << 1) + ((WORD
)(csd
[11] & 128) >> 7) + 1) << ((csd
[13] >> 6) - 1);
697 *(DWORD
*)buff
= ((WORD
)((csd
[10] & 124) >> 2) + 1) * (((csd
[11] & 3) << 3) + ((csd
[11] & 224) >> 5) + 1);
704 /* Following commands are never used by FatFs module */
706 case MMC_GET_TYPE
: /* Get card type flags (1 byte) */
707 *ptr
= socket
[drv
].CardType
;
711 case MMC_GET_CSD
: /* Receive CSD as a data block (16 bytes) */
712 if (send_cmd(drv
, CMD9
, 0) == 0 /* READ_CSD */
713 && rcvr_datablock(ptr
, 16))
717 case MMC_GET_CID
: /* Receive CID as a data block (16 bytes) */
718 if (send_cmd(drv
, CMD10
, 0) == 0 /* READ_CID */
719 && rcvr_datablock(ptr
, 16))
723 case MMC_GET_OCR
: /* Receive OCR as an R3 resp (4 bytes) */
724 if (send_cmd(drv
, CMD58
, 0) == 0) { /* READ_OCR */
731 case MMC_GET_SDSTAT
: /* Receive SD status as a data block (64 bytes) */
732 if (send_cmd(drv
, ACMD13
, 0) == 0) { /* SD_STATUS */
734 if (rcvr_datablock(ptr
, 64))
739 case CTRL_POWER_OFF
: /* Power off */
752 #endif /* _USE_IOCTL */
754 /*-----------------------------------------------------------------------*/
755 /* Device Timer Interrupt Procedure (Platform dependent) */
756 /*-----------------------------------------------------------------------*/
757 /* This function must be called in period of 10ms */
759 void disk_timerproc (void)
765 if (SD_WP_0_IN
== 0) /* Write protected */
767 else /* Write enabled */
772 if (SD_CD_0_IN
== 0) /* Card inserted */
774 else /* Socket empty */
775 s
|= (STA_NODISK
| STA_NOINIT
);
776 #elif defined SD_CS_0_IN
777 if (SD_CS_0_DDR
== 0) {
778 if (SD_CS_0_IN
== 1) /* Card inserted */
780 else /* Socket empty */
781 s
|= (STA_NODISK
| STA_NOINIT
);
784 socket
[0].stat
= s
; /* Update MMC status */
788 if (SD_WP_1_IN
== 0) /* Write protected */
790 else /* Write enabled */
795 if (SD_CD_1_IN
== 0) /* Card inserted */
797 else /* Socket empty */
798 s
|= (STA_NODISK
| STA_NOINIT
);
799 #elif defined SD_CS_1_IN
800 if (SD_CS_1_DDR
== 0) {
801 if (SD_CS_1_IN
== 1) /* Card inserted */
803 else /* Socket empty */
804 s
|= (STA_NODISK
| STA_NOINIT
);
807 socket
[1].stat
= s
; /* Update MMC status */