spinal cord / PokittoLib

PokittoLib is the library needed for programming the Pokitto DIY game console (www.pokitto.com)

Dependents:   Sensitive

Fork of PokittoLib by Jonne Valola

libpff/mmc.cpp@15:0bbe8f6fae32, 2017-10-18 (annotated)

Committer:
spinal
Date:
Wed Oct 18 14:47:54 2017 +0000
Revision:
15:0bbe8f6fae32
Parent:
0:e8b8f36b4505 
direct lcd stuff used by sensitive

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Pokitto 0:e8b8f36b4505 1 /*-----------------------------------------------------------------------*/
Pokitto 0:e8b8f36b4505 2 /* PFF - Low level disk control module for ATtiny85 (C)ChaN, 2009 */
Pokitto 0:e8b8f36b4505 3 /*-----------------------------------------------------------------------*/
Pokitto 0:e8b8f36b4505 4
Pokitto 0:e8b8f36b4505 5 #define _WRITE_FUNC 1
Pokitto 0:e8b8f36b4505 6
Pokitto 0:e8b8f36b4505 7 #include "diskio.h"
Pokitto 0:e8b8f36b4505 8 #include "mbed.h"
Pokitto 0:e8b8f36b4505 9 #include "connect.h"
Pokitto 0:e8b8f36b4505 10 #include "PokittoDisk.h"
Pokitto 0:e8b8f36b4505 11
Pokitto 0:e8b8f36b4505 12 /* Definitions for MMC/SDC command */
Pokitto 0:e8b8f36b4505 13 #define CMD0 (0x40+0) /* GO_IDLE_STATE */
Pokitto 0:e8b8f36b4505 14 #define CMD1 (0x40+1) /* SEND_OP_COND (MMC) */
Pokitto 0:e8b8f36b4505 15 #define ACMD41 (0xC0+41) /* SEND_OP_COND (SDC) */
Pokitto 0:e8b8f36b4505 16 #define CMD8 (0x40+8) /* SEND_IF_COND */
Pokitto 0:e8b8f36b4505 17 #define CMD16 (0x40+16) /* SET_BLOCKLEN */
Pokitto 0:e8b8f36b4505 18 #define CMD17 (0x40+17) /* READ_SINGLE_BLOCK */
Pokitto 0:e8b8f36b4505 19 #define CMD24 (0x40+24) /* WRITE_BLOCK */
Pokitto 0:e8b8f36b4505 20 #define CMD55 (0x40+55) /* APP_CMD */
Pokitto 0:e8b8f36b4505 21 #define CMD58 (0x40+58) /* READ_OCR */
Pokitto 0:e8b8f36b4505 22
Pokitto 0:e8b8f36b4505 23
Pokitto 0:e8b8f36b4505 24
Pokitto 0:e8b8f36b4505 25 /* Port Controls (Platform dependent) */
Pokitto 0:e8b8f36b4505 26 #define SELECT() CLR_SD_CS //mmccs.write(0) /* MMC CS = L */
Pokitto 0:e8b8f36b4505 27 #define DESELECT() SET_SD_CS // mmccs.write(1) /* MMC CS = H */
Pokitto 0:e8b8f36b4505 28 #define MMC_SEL !GET_SD_CS // !mmccs.read() /* MMC CS status (true:selected) */
Pokitto 0:e8b8f36b4505 29
Pokitto 0:e8b8f36b4505 30 void xmit_spi (BYTE c) {
Pokitto 0:e8b8f36b4505 31 device.write(c); /* Send a byte */
Pokitto 0:e8b8f36b4505 32 }
Pokitto 0:e8b8f36b4505 33
Pokitto 0:e8b8f36b4505 34 BYTE rcv_spi (void) {
Pokitto 0:e8b8f36b4505 35 return device.write(0xff);
Pokitto 0:e8b8f36b4505 36 }
Pokitto 0:e8b8f36b4505 37
Pokitto 0:e8b8f36b4505 38 /*--------------------------------------------------------------------------
Pokitto 0:e8b8f36b4505 39
Pokitto 0:e8b8f36b4505 40 Module Private Functions
Pokitto 0:e8b8f36b4505 41
Pokitto 0:e8b8f36b4505 42 ---------------------------------------------------------------------------*/
Pokitto 0:e8b8f36b4505 43
Pokitto 0:e8b8f36b4505 44 static
Pokitto 0:e8b8f36b4505 45 BYTE CardType;
Pokitto 0:e8b8f36b4505 46
Pokitto 0:e8b8f36b4505 47
Pokitto 0:e8b8f36b4505 48 /*-----------------------------------------------------------------------*/
Pokitto 0:e8b8f36b4505 49 /* Deselect the card and release SPI bus */
Pokitto 0:e8b8f36b4505 50 /*-----------------------------------------------------------------------*/
Pokitto 0:e8b8f36b4505 51
Pokitto 0:e8b8f36b4505 52 static
Pokitto 0:e8b8f36b4505 53 void release_spi (void) {
Pokitto 0:e8b8f36b4505 54 DESELECT();
Pokitto 0:e8b8f36b4505 55 rcv_spi();
Pokitto 0:e8b8f36b4505 56 }
Pokitto 0:e8b8f36b4505 57
Pokitto 0:e8b8f36b4505 58
Pokitto 0:e8b8f36b4505 59 /*-----------------------------------------------------------------------*/
Pokitto 0:e8b8f36b4505 60 /* Send a command packet to MMC */
Pokitto 0:e8b8f36b4505 61 /*-----------------------------------------------------------------------*/
Pokitto 0:e8b8f36b4505 62
Pokitto 0:e8b8f36b4505 63 static
Pokitto 0:e8b8f36b4505 64 BYTE send_cmd (
Pokitto 0:e8b8f36b4505 65 BYTE cmd, /* Command byte */
Pokitto 0:e8b8f36b4505 66 DWORD arg /* Argument */
Pokitto 0:e8b8f36b4505 67 ) {
Pokitto 0:e8b8f36b4505 68 BYTE n, res;
Pokitto 0:e8b8f36b4505 69
Pokitto 0:e8b8f36b4505 70
Pokitto 0:e8b8f36b4505 71 if (cmd & 0x80) { /* ACMD<n> is the command sequense of CMD55-CMD<n> */
Pokitto 0:e8b8f36b4505 72 cmd &= 0x7F;
Pokitto 0:e8b8f36b4505 73 res = send_cmd(CMD55, 0);
Pokitto 0:e8b8f36b4505 74 if (res > 1) return res;
Pokitto 0:e8b8f36b4505 75 }
Pokitto 0:e8b8f36b4505 76
Pokitto 0:e8b8f36b4505 77 /* Select the card */
Pokitto 0:e8b8f36b4505 78 DESELECT();
Pokitto 0:e8b8f36b4505 79 rcv_spi();
Pokitto 0:e8b8f36b4505 80 SELECT();
Pokitto 0:e8b8f36b4505 81 rcv_spi();
Pokitto 0:e8b8f36b4505 82
Pokitto 0:e8b8f36b4505 83 /* Send a command packet */
Pokitto 0:e8b8f36b4505 84 xmit_spi(cmd); /* Start + Command index */
Pokitto 0:e8b8f36b4505 85 xmit_spi((BYTE)(arg >> 24)); /* Argument[31..24] */
Pokitto 0:e8b8f36b4505 86 xmit_spi((BYTE)(arg >> 16)); /* Argument[23..16] */
Pokitto 0:e8b8f36b4505 87 xmit_spi((BYTE)(arg >> 8)); /* Argument[15..8] */
Pokitto 0:e8b8f36b4505 88 xmit_spi((BYTE)arg); /* Argument[7..0] */
Pokitto 0:e8b8f36b4505 89 n = 0x01; /* Dummy CRC + Stop */
Pokitto 0:e8b8f36b4505 90 if (cmd == CMD0) n = 0x95; /* Valid CRC for CMD0(0) */
Pokitto 0:e8b8f36b4505 91 if (cmd == CMD8) n = 0x87; /* Valid CRC for CMD8(0x1AA) */
Pokitto 0:e8b8f36b4505 92 xmit_spi(n);
Pokitto 0:e8b8f36b4505 93
Pokitto 0:e8b8f36b4505 94 /* Receive a command response */
Pokitto 0:e8b8f36b4505 95 n = 10; /* Wait for a valid response in timeout of 10 attempts */
Pokitto 0:e8b8f36b4505 96 do {
Pokitto 0:e8b8f36b4505 97 res = rcv_spi();
Pokitto 0:e8b8f36b4505 98 } while ((res & 0x80) && --n);
Pokitto 0:e8b8f36b4505 99
Pokitto 0:e8b8f36b4505 100 return res; /* Return with the response value */
Pokitto 0:e8b8f36b4505 101 }
Pokitto 0:e8b8f36b4505 102
Pokitto 0:e8b8f36b4505 103
Pokitto 0:e8b8f36b4505 104
Pokitto 0:e8b8f36b4505 105 /*--------------------------------------------------------------------------
Pokitto 0:e8b8f36b4505 106
Pokitto 0:e8b8f36b4505 107 Public Functions
Pokitto 0:e8b8f36b4505 108
Pokitto 0:e8b8f36b4505 109 ---------------------------------------------------------------------------*/
Pokitto 0:e8b8f36b4505 110
Pokitto 0:e8b8f36b4505 111
Pokitto 0:e8b8f36b4505 112 /*-----------------------------------------------------------------------*/
Pokitto 0:e8b8f36b4505 113 /* Initialize Disk Drive */
Pokitto 0:e8b8f36b4505 114 /*-----------------------------------------------------------------------*/
Pokitto 0:e8b8f36b4505 115
Pokitto 0:e8b8f36b4505 116 //__attribute__((section(".SD_Code")))
Pokitto 0:e8b8f36b4505 117 DSTATUS disk_initialize (void) {
Pokitto 0:e8b8f36b4505 118 BYTE n, cmd, ty, ocr[4];
Pokitto 0:e8b8f36b4505 119 WORD tmr;
Pokitto 0:e8b8f36b4505 120
Pokitto 0:e8b8f36b4505 121 DESELECT();
Pokitto 0:e8b8f36b4505 122 device.frequency(SPI_FREQ);
Pokitto 0:e8b8f36b4505 123 device.format(8);
Pokitto 0:e8b8f36b4505 124 // device.frequency(SPI_FREQ); // hangs if this is after format
Pokitto 0:e8b8f36b4505 125
Pokitto 0:e8b8f36b4505 126 #if _WRITE_FUNC
Pokitto 0:e8b8f36b4505 127 if (MMC_SEL) disk_writep(0, 0); /* Finalize write process if it is in progress */
Pokitto 0:e8b8f36b4505 128 #endif
Pokitto 0:e8b8f36b4505 129 for (n = 100; n; n--) rcv_spi(); /* Dummy clocks */
Pokitto 0:e8b8f36b4505 130
Pokitto 0:e8b8f36b4505 131 ty = 0;
Pokitto 0:e8b8f36b4505 132 if (send_cmd(CMD0, 0) == 1) { /* Enter Idle state */
Pokitto 0:e8b8f36b4505 133 if (send_cmd(CMD8, 0x1AA) == 1) { /* SDv2 */
Pokitto 0:e8b8f36b4505 134 for (n = 0; n < 4; n++) ocr[n] = rcv_spi(); /* Get trailing return value of R7 resp */
Pokitto 0:e8b8f36b4505 135 if (ocr[2] == 0x01 && ocr[3] == 0xAA) { /* The card can work at vdd range of 2.7-3.6V */
Pokitto 0:e8b8f36b4505 136 for (tmr = 12000; tmr && send_cmd(ACMD41, 1UL << 30); tmr--) ; /* Wait for leaving idle state (ACMD41 with HCS bit) */
Pokitto 0:e8b8f36b4505 137 if (tmr && send_cmd(CMD58, 0) == 0) { /* Check CCS bit in the OCR */
Pokitto 0:e8b8f36b4505 138 for (n = 0; n < 4; n++) ocr[n] = rcv_spi();
Pokitto 0:e8b8f36b4505 139 ty = (ocr[0] & 0x40) ? CT_SD2 | CT_BLOCK : CT_SD2; /* SDv2 (HC or SC) */
Pokitto 0:e8b8f36b4505 140 }
Pokitto 0:e8b8f36b4505 141 }
Pokitto 0:e8b8f36b4505 142 } else { /* SDv1 or MMCv3 */
Pokitto 0:e8b8f36b4505 143 if (send_cmd(ACMD41, 0) <= 1) {
Pokitto 0:e8b8f36b4505 144 ty = CT_SD1;
Pokitto 0:e8b8f36b4505 145 cmd = ACMD41; /* SDv1 */
Pokitto 0:e8b8f36b4505 146 } else {
Pokitto 0:e8b8f36b4505 147 ty = CT_MMC;
Pokitto 0:e8b8f36b4505 148 cmd = CMD1; /* MMCv3 */
Pokitto 0:e8b8f36b4505 149 }
Pokitto 0:e8b8f36b4505 150 for (tmr = 25000; tmr && send_cmd(cmd, 0); tmr--) ; /* Wait for leaving idle state */
Pokitto 0:e8b8f36b4505 151 if (!tmr || send_cmd(CMD16, 512) != 0) /* Set R/W block length to 512 */
Pokitto 0:e8b8f36b4505 152 ty = 0;
Pokitto 0:e8b8f36b4505 153 }
Pokitto 0:e8b8f36b4505 154 }
Pokitto 0:e8b8f36b4505 155 CardType = ty;
Pokitto 0:e8b8f36b4505 156 release_spi();
Pokitto 0:e8b8f36b4505 157
Pokitto 0:e8b8f36b4505 158 return ty ? 0 : STA_NOINIT;
Pokitto 0:e8b8f36b4505 159 }
Pokitto 0:e8b8f36b4505 160
Pokitto 0:e8b8f36b4505 161
Pokitto 0:e8b8f36b4505 162
Pokitto 0:e8b8f36b4505 163 /*-----------------------------------------------------------------------*/
Pokitto 0:e8b8f36b4505 164 /* Read partial sector */
Pokitto 0:e8b8f36b4505 165 /*-----------------------------------------------------------------------*/
Pokitto 0:e8b8f36b4505 166
Pokitto 0:e8b8f36b4505 167 DRESULT disk_readp (
Pokitto 0:e8b8f36b4505 168 BYTE *buff, /* Pointer to the read buffer (NULL:Read bytes are forwarded to the stream) */
Pokitto 0:e8b8f36b4505 169 DWORD lba, /* Sector number (LBA) */
Pokitto 0:e8b8f36b4505 170 WORD ofs, /* Byte offset to read from (0..511) */
Pokitto 0:e8b8f36b4505 171 WORD cnt /* Number of bytes to read (ofs + cnt mus be <= 512) */
Pokitto 0:e8b8f36b4505 172 ) {
Pokitto 0:e8b8f36b4505 173 DRESULT res;
Pokitto 0:e8b8f36b4505 174 BYTE rc;
Pokitto 0:e8b8f36b4505 175 WORD bc;
Pokitto 0:e8b8f36b4505 176
Pokitto 0:e8b8f36b4505 177
Pokitto 0:e8b8f36b4505 178 if (!(CardType & CT_BLOCK)) lba *= 512; /* Convert to byte address if needed */
Pokitto 0:e8b8f36b4505 179
Pokitto 0:e8b8f36b4505 180 res = RES_ERROR;
Pokitto 0:e8b8f36b4505 181 if (send_cmd(CMD17, lba) == 0) { /* READ_SINGLE_BLOCK */
Pokitto 0:e8b8f36b4505 182
Pokitto 0:e8b8f36b4505 183 bc = 30000;
Pokitto 0:e8b8f36b4505 184 do { /* Wait for data packet in timeout of 100ms */
Pokitto 0:e8b8f36b4505 185 rc = rcv_spi();
Pokitto 0:e8b8f36b4505 186 } while (rc == 0xFF && --bc);
Pokitto 0:e8b8f36b4505 187
Pokitto 0:e8b8f36b4505 188 if (rc == 0xFE) { /* A data packet arrived */
Pokitto 0:e8b8f36b4505 189 bc = 514 - ofs - cnt;
Pokitto 0:e8b8f36b4505 190
Pokitto 0:e8b8f36b4505 191 /* Skip leading bytes */
Pokitto 0:e8b8f36b4505 192 if (ofs) {
Pokitto 0:e8b8f36b4505 193 do {
Pokitto 0:e8b8f36b4505 194 rcv_spi();
Pokitto 0:e8b8f36b4505 195 } while (--ofs);
Pokitto 0:e8b8f36b4505 196 }
Pokitto 0:e8b8f36b4505 197
Pokitto 0:e8b8f36b4505 198 /* Receive a part of the sector */
Pokitto 0:e8b8f36b4505 199 if (buff) { /* Store data to the memory */
Pokitto 0:e8b8f36b4505 200 do {
Pokitto 0:e8b8f36b4505 201 *buff++ = rcv_spi();
Pokitto 0:e8b8f36b4505 202 } while (--cnt);
Pokitto 0:e8b8f36b4505 203 } else { /* Forward data to the outgoing stream (depends on the project) */
Pokitto 0:e8b8f36b4505 204 do {
Pokitto 0:e8b8f36b4505 205 rcv_spi();
Pokitto 0:e8b8f36b4505 206 } while (--cnt);
Pokitto 0:e8b8f36b4505 207 }
Pokitto 0:e8b8f36b4505 208
Pokitto 0:e8b8f36b4505 209 /* Skip trailing bytes and CRC */
Pokitto 0:e8b8f36b4505 210 do rcv_spi();
Pokitto 0:e8b8f36b4505 211 while (--bc);
Pokitto 0:e8b8f36b4505 212
Pokitto 0:e8b8f36b4505 213 res = RES_OK;
Pokitto 0:e8b8f36b4505 214 }
Pokitto 0:e8b8f36b4505 215 }
Pokitto 0:e8b8f36b4505 216
Pokitto 0:e8b8f36b4505 217 release_spi();
Pokitto 0:e8b8f36b4505 218
Pokitto 0:e8b8f36b4505 219 return res;
Pokitto 0:e8b8f36b4505 220 }
Pokitto 0:e8b8f36b4505 221
Pokitto 0:e8b8f36b4505 222
Pokitto 0:e8b8f36b4505 223
Pokitto 0:e8b8f36b4505 224 /*-----------------------------------------------------------------------*/
Pokitto 0:e8b8f36b4505 225 /* Write partial sector */
Pokitto 0:e8b8f36b4505 226 /*-----------------------------------------------------------------------*/
Pokitto 0:e8b8f36b4505 227 #if _WRITE_FUNC
Pokitto 0:e8b8f36b4505 228
Pokitto 0:e8b8f36b4505 229 DRESULT disk_writep (
Pokitto 0:e8b8f36b4505 230 const BYTE *buff, /* Pointer to the bytes to be written (NULL:Initiate/Finalize sector write) */
Pokitto 0:e8b8f36b4505 231 DWORD sa /* Number of bytes to send, Sector number (LBA) or zero */
Pokitto 0:e8b8f36b4505 232 ) {
Pokitto 0:e8b8f36b4505 233 DRESULT res;
Pokitto 0:e8b8f36b4505 234 WORD bc;
Pokitto 0:e8b8f36b4505 235 static WORD wc;
Pokitto 0:e8b8f36b4505 236
Pokitto 0:e8b8f36b4505 237
Pokitto 0:e8b8f36b4505 238 res = RES_ERROR;
Pokitto 0:e8b8f36b4505 239
Pokitto 0:e8b8f36b4505 240 if (buff) { /* Send data bytes */
Pokitto 0:e8b8f36b4505 241 bc = (WORD)sa;
Pokitto 0:e8b8f36b4505 242 while (bc && wc) { /* Send data bytes to the card */
Pokitto 0:e8b8f36b4505 243 xmit_spi(*buff++);
Pokitto 0:e8b8f36b4505 244 wc--;
Pokitto 0:e8b8f36b4505 245 bc--;
Pokitto 0:e8b8f36b4505 246 }
Pokitto 0:e8b8f36b4505 247 res = RES_OK;
Pokitto 0:e8b8f36b4505 248 } else {
Pokitto 0:e8b8f36b4505 249 if (sa) { /* Initiate sector write process */
Pokitto 0:e8b8f36b4505 250 if (!(CardType & CT_BLOCK)) sa *= 512; /* Convert to byte address if needed */
Pokitto 0:e8b8f36b4505 251 if (send_cmd(CMD24, sa) == 0) { /* WRITE_SINGLE_BLOCK */
Pokitto 0:e8b8f36b4505 252 xmit_spi(0xFF);
Pokitto 0:e8b8f36b4505 253 xmit_spi(0xFE); /* Data block header */
Pokitto 0:e8b8f36b4505 254 wc = 512; /* Set byte counter */
Pokitto 0:e8b8f36b4505 255 res = RES_OK;
Pokitto 0:e8b8f36b4505 256 }
Pokitto 0:e8b8f36b4505 257 } else { /* Finalize sector write process */
Pokitto 0:e8b8f36b4505 258 bc = wc + 2;
Pokitto 0:e8b8f36b4505 259 while (bc--) xmit_spi(0); /* Fill left bytes and CRC with zeros */
Pokitto 0:e8b8f36b4505 260 if ((rcv_spi() & 0x1F) == 0x05) { /* Receive data resp and wait for end of write process in timeout of 300ms */
Pokitto 0:e8b8f36b4505 261 for (bc = 65000; rcv_spi() != 0xFF && bc; bc--) ; /* Wait ready */
Pokitto 0:e8b8f36b4505 262 if (bc) res = RES_OK;
Pokitto 0:e8b8f36b4505 263 }
Pokitto 0:e8b8f36b4505 264 release_spi();
Pokitto 0:e8b8f36b4505 265 }
Pokitto 0:e8b8f36b4505 266 }
Pokitto 0:e8b8f36b4505 267
Pokitto 0:e8b8f36b4505 268 return res;
Pokitto 0:e8b8f36b4505 269 }
Pokitto 0:e8b8f36b4505 270 #endif
Pokitto 0:e8b8f36b4505 271