GPS_Logger_v1 - GPS Data Logger with SD File system. Logger can s…

Users » kenjiArai » Code » GPS_Logger_v1

Kenji Arai / Mbed 2 deprecated GPS_Logger_v1

GPS Data Logger with SD File system. Logger can save RMC & GGA data from GPS and five channels of analog data. Based on http://mbed.org/users/prf/ "GPS_Logger_01" by Peter Forden

Dependencies: mbed

SDFileSystem.cpp@0:dc3be3264d2d, 2010-04-17 (annotated)

Committer:: kenjiArai
Date:: Sat Apr 17 13:27:34 2010 +0000
Revision:: 0:dc3be3264d2d

Who changed what in which revision?

User	Revision	Line number	New contents of line
kenjiArai	0:dc3be3264d2d	1	/* mbed Microcontroller Library - SDFileSystem
kenjiArai	0:dc3be3264d2d	2	* Copyright (c) 2008-2009, sford
kenjiArai	0:dc3be3264d2d	3	*/
kenjiArai	0:dc3be3264d2d	4
kenjiArai	0:dc3be3264d2d	5	// VERY DRAFT CODE! Needs serious rework/refactoring
kenjiArai	0:dc3be3264d2d	6
kenjiArai	0:dc3be3264d2d	7	/* Introduction
kenjiArai	0:dc3be3264d2d	8	* ------------
kenjiArai	0:dc3be3264d2d	9	* SD and MMC cards support a number of interfaces, but common to them all
kenjiArai	0:dc3be3264d2d	10	* is one based on SPI. This is the one I'm implmenting because it means
kenjiArai	0:dc3be3264d2d	11	* it is much more portable even though not so performant, and we already
kenjiArai	0:dc3be3264d2d	12	* have the mbed SPI Interface!
kenjiArai	0:dc3be3264d2d	13	*
kenjiArai	0:dc3be3264d2d	14	* The main reference I'm using is Chapter 7, "SPI Mode" of:
kenjiArai	0:dc3be3264d2d	15	* http://www.sdcard.org/developers/tech/sdcard/pls/Simplified_Physical_Layer_Spec.pdf
kenjiArai	0:dc3be3264d2d	16	*
kenjiArai	0:dc3be3264d2d	17	* SPI Startup
kenjiArai	0:dc3be3264d2d	18	* -----------
kenjiArai	0:dc3be3264d2d	19	* The SD card powers up in SD mode. The SPI interface mode is selected by
kenjiArai	0:dc3be3264d2d	20	* asserting CS low and sending the reset command (CMD0). The card will
kenjiArai	0:dc3be3264d2d	21	* respond with a (R1) response.
kenjiArai	0:dc3be3264d2d	22	*
kenjiArai	0:dc3be3264d2d	23	* CMD8 is optionally sent to determine the voltage range supported, and
kenjiArai	0:dc3be3264d2d	24	* indirectly determine whether it is a version 1.x SD/non-SD card or
kenjiArai	0:dc3be3264d2d	25	* version 2.x. I'll just ignore this for now.
kenjiArai	0:dc3be3264d2d	26	*
kenjiArai	0:dc3be3264d2d	27	* ACMD41 is repeatedly issued to initialise the card, until "in idle"
kenjiArai	0:dc3be3264d2d	28	* (bit 0) of the R1 response goes to '0', indicating it is initialised.
kenjiArai	0:dc3be3264d2d	29	*
kenjiArai	0:dc3be3264d2d	30	* You should also indicate whether the host supports High Capicity cards,
kenjiArai	0:dc3be3264d2d	31	* and check whether the card is high capacity - i'll also ignore this
kenjiArai	0:dc3be3264d2d	32	*
kenjiArai	0:dc3be3264d2d	33	* SPI Protocol
kenjiArai	0:dc3be3264d2d	34	* ------------
kenjiArai	0:dc3be3264d2d	35	* The SD SPI protocol is based on transactions made up of 8-bit words, with
kenjiArai	0:dc3be3264d2d	36	* the host starting every bus transaction by asserting the CS signal low. The
kenjiArai	0:dc3be3264d2d	37	* card always responds to commands, data blocks and errors.
kenjiArai	0:dc3be3264d2d	38	*
kenjiArai	0:dc3be3264d2d	39	* The protocol supports a CRC, but by default it is off (except for the
kenjiArai	0:dc3be3264d2d	40	* first reset CMD0, where the CRC can just be pre-calculated, and CMD8)
kenjiArai	0:dc3be3264d2d	41	* I'll leave the CRC off I think!
kenjiArai	0:dc3be3264d2d	42	*
kenjiArai	0:dc3be3264d2d	43	* Standard capacity cards have variable data block sizes, whereas High
kenjiArai	0:dc3be3264d2d	44	* Capacity cards fix the size of data block to 512 bytes. I'll therefore
kenjiArai	0:dc3be3264d2d	45	* just always use the Standard Capacity cards with a block size of 512 bytes.
kenjiArai	0:dc3be3264d2d	46	* This is set with CMD16.
kenjiArai	0:dc3be3264d2d	47	*
kenjiArai	0:dc3be3264d2d	48	* You can read and write single blocks (CMD17, CMD25) or multiple blocks
kenjiArai	0:dc3be3264d2d	49	* (CMD18, CMD25). For simplicity, I'll just use single block accesses. When
kenjiArai	0:dc3be3264d2d	50	* the card gets a read command, it responds with a response token, and then
kenjiArai	0:dc3be3264d2d	51	* a data token or an error.
kenjiArai	0:dc3be3264d2d	52	*
kenjiArai	0:dc3be3264d2d	53	* SPI Command Format
kenjiArai	0:dc3be3264d2d	54	* ------------------
kenjiArai	0:dc3be3264d2d	55	* Commands are 6-bytes long, containing the command, 32-bit argument, and CRC.
kenjiArai	0:dc3be3264d2d	56	*
kenjiArai	0:dc3be3264d2d	57	* +---------------+------------+------------+-----------+----------+--------------+
kenjiArai	0:dc3be3264d2d	58	* \| 01 \| cmd[5:0] \| arg[31:24] \| arg[23:16] \| arg[15:8] \| arg[7:0] \| crc[6:0] \| 1 \|
kenjiArai	0:dc3be3264d2d	59	* +---------------+------------+------------+-----------+----------+--------------+
kenjiArai	0:dc3be3264d2d	60	*
kenjiArai	0:dc3be3264d2d	61	* As I'm not using CRC, I can fix that byte to what is needed for CMD0 (0x95)
kenjiArai	0:dc3be3264d2d	62	*
kenjiArai	0:dc3be3264d2d	63	* All Application Specific commands shall be preceded with APP_CMD (CMD55).
kenjiArai	0:dc3be3264d2d	64	*
kenjiArai	0:dc3be3264d2d	65	* SPI Response Format
kenjiArai	0:dc3be3264d2d	66	* -------------------
kenjiArai	0:dc3be3264d2d	67	* The main response format (R1) is a status byte (normally zero). Key flags:
kenjiArai	0:dc3be3264d2d	68	* idle - 1 if the card is in an idle state/initialising
kenjiArai	0:dc3be3264d2d	69	* cmd - 1 if an illegal command code was detected
kenjiArai	0:dc3be3264d2d	70	*
kenjiArai	0:dc3be3264d2d	71	* +-------------------------------------------------+
kenjiArai	0:dc3be3264d2d	72	* R1 \| 0 \| arg \| addr \| seq \| crc \| cmd \| erase \| idle \|
kenjiArai	0:dc3be3264d2d	73	* +-------------------------------------------------+
kenjiArai	0:dc3be3264d2d	74	*
kenjiArai	0:dc3be3264d2d	75	* R1b is the same, except it is followed by a busy signal (zeros) until
kenjiArai	0:dc3be3264d2d	76	* the first non-zero byte when it is ready again.
kenjiArai	0:dc3be3264d2d	77	*
kenjiArai	0:dc3be3264d2d	78	* Data Response Token
kenjiArai	0:dc3be3264d2d	79	* -------------------
kenjiArai	0:dc3be3264d2d	80	* Every data block written to the card is acknowledged by a byte
kenjiArai	0:dc3be3264d2d	81	* response token
kenjiArai	0:dc3be3264d2d	82	*
kenjiArai	0:dc3be3264d2d	83	* +----------------------+
kenjiArai	0:dc3be3264d2d	84	* \| xxx \| 0 \| status \| 1 \|
kenjiArai	0:dc3be3264d2d	85	* +----------------------+
kenjiArai	0:dc3be3264d2d	86	* 010 - OK!
kenjiArai	0:dc3be3264d2d	87	* 101 - CRC Error
kenjiArai	0:dc3be3264d2d	88	* 110 - Write Error
kenjiArai	0:dc3be3264d2d	89	*
kenjiArai	0:dc3be3264d2d	90	* Single Block Read and Write
kenjiArai	0:dc3be3264d2d	91	* ---------------------------
kenjiArai	0:dc3be3264d2d	92	*
kenjiArai	0:dc3be3264d2d	93	* Block transfers have a byte header, followed by the data, followed
kenjiArai	0:dc3be3264d2d	94	* by a 16-bit CRC. In our case, the data will always be 512 bytes.
kenjiArai	0:dc3be3264d2d	95	*
kenjiArai	0:dc3be3264d2d	96	* +------+---------+---------+- - - -+---------+-----------+----------+
kenjiArai	0:dc3be3264d2d	97	* \| 0xFE \| data[0] \| data[1] \| \| data[n] \| crc[15:8] \| crc[7:0] \|
kenjiArai	0:dc3be3264d2d	98	* +------+---------+---------+- - - -+---------+-----------+----------+
kenjiArai	0:dc3be3264d2d	99	*/
kenjiArai	0:dc3be3264d2d	100
kenjiArai	0:dc3be3264d2d	101	#include "SDFileSystem.h"
kenjiArai	0:dc3be3264d2d	102
kenjiArai	0:dc3be3264d2d	103	#define SD_COMMAND_TIMEOUT 5000
kenjiArai	0:dc3be3264d2d	104
kenjiArai	0:dc3be3264d2d	105	SDFileSystem::SDFileSystem(PinName mosi, PinName miso, PinName sclk, PinName cs, const char* name) :
kenjiArai	0:dc3be3264d2d	106	FATFileSystem(name), _spi(mosi, miso, sclk), _cs(cs) {
kenjiArai	0:dc3be3264d2d	107	_cs = 1;
kenjiArai	0:dc3be3264d2d	108	}
kenjiArai	0:dc3be3264d2d	109
kenjiArai	0:dc3be3264d2d	110	#define R1_IDLE_STATE (1 << 0)
kenjiArai	0:dc3be3264d2d	111	#define R1_ERASE_RESET (1 << 1)
kenjiArai	0:dc3be3264d2d	112	#define R1_ILLEGAL_COMMAND (1 << 2)
kenjiArai	0:dc3be3264d2d	113	#define R1_COM_CRC_ERROR (1 << 3)
kenjiArai	0:dc3be3264d2d	114	#define R1_ERASE_SEQUENCE_ERROR (1 << 4)
kenjiArai	0:dc3be3264d2d	115	#define R1_ADDRESS_ERROR (1 << 5)
kenjiArai	0:dc3be3264d2d	116	#define R1_PARAMETER_ERROR (1 << 6)
kenjiArai	0:dc3be3264d2d	117
kenjiArai	0:dc3be3264d2d	118	// Types
kenjiArai	0:dc3be3264d2d	119	// - v1.x Standard Capacity
kenjiArai	0:dc3be3264d2d	120	// - v2.x Standard Capacity
kenjiArai	0:dc3be3264d2d	121	// - v2.x High Capacity
kenjiArai	0:dc3be3264d2d	122	// - Not recognised as an SD Card
kenjiArai	0:dc3be3264d2d	123
kenjiArai	0:dc3be3264d2d	124	#define SDCARD_FAIL 0
kenjiArai	0:dc3be3264d2d	125	#define SDCARD_V1 1
kenjiArai	0:dc3be3264d2d	126	#define SDCARD_V2 2
kenjiArai	0:dc3be3264d2d	127	#define SDCARD_V2HC 3
kenjiArai	0:dc3be3264d2d	128
kenjiArai	0:dc3be3264d2d	129	int SDFileSystem::initialise_card() {
kenjiArai	0:dc3be3264d2d	130	// Set to 100kHz for initialisation, and clock card with cs = 1
kenjiArai	0:dc3be3264d2d	131	_spi.frequency(100000);
kenjiArai	0:dc3be3264d2d	132	_cs = 1;
kenjiArai	0:dc3be3264d2d	133	for(int i=0; i<16; i++) {
kenjiArai	0:dc3be3264d2d	134	_spi.write(0xFF);
kenjiArai	0:dc3be3264d2d	135	}
kenjiArai	0:dc3be3264d2d	136
kenjiArai	0:dc3be3264d2d	137	// send CMD0, should return with all zeros except IDLE STATE set (bit 0)
kenjiArai	0:dc3be3264d2d	138	if(_cmd(0, 0) != R1_IDLE_STATE) {
kenjiArai	0:dc3be3264d2d	139	fprintf(stderr, "No disk, or could not put SD card in to SPI idle state\n");
kenjiArai	0:dc3be3264d2d	140	return SDCARD_FAIL;
kenjiArai	0:dc3be3264d2d	141	}
kenjiArai	0:dc3be3264d2d	142
kenjiArai	0:dc3be3264d2d	143	// send CMD8 to determine whther it is ver 2.x
kenjiArai	0:dc3be3264d2d	144	int r = _cmd8();
kenjiArai	0:dc3be3264d2d	145	if(r == R1_IDLE_STATE) {
kenjiArai	0:dc3be3264d2d	146	return initialise_card_v2();
kenjiArai	0:dc3be3264d2d	147	} else if(r == (R1_IDLE_STATE \| R1_ILLEGAL_COMMAND)) {
kenjiArai	0:dc3be3264d2d	148	return initialise_card_v1();
kenjiArai	0:dc3be3264d2d	149	} else {
kenjiArai	0:dc3be3264d2d	150	fprintf(stderr, "Not in idle state after sending CMD8 (not an SD card?)\n");
kenjiArai	0:dc3be3264d2d	151	return SDCARD_FAIL;
kenjiArai	0:dc3be3264d2d	152	}
kenjiArai	0:dc3be3264d2d	153	}
kenjiArai	0:dc3be3264d2d	154
kenjiArai	0:dc3be3264d2d	155	int SDFileSystem::initialise_card_v1() {
kenjiArai	0:dc3be3264d2d	156	for(int i=0; i<SD_COMMAND_TIMEOUT; i++) {
kenjiArai	0:dc3be3264d2d	157	_cmd(55, 0);
kenjiArai	0:dc3be3264d2d	158	if(_cmd(41, 0) == 0) {
kenjiArai	0:dc3be3264d2d	159	return SDCARD_V1;
kenjiArai	0:dc3be3264d2d	160	}
kenjiArai	0:dc3be3264d2d	161	}
kenjiArai	0:dc3be3264d2d	162
kenjiArai	0:dc3be3264d2d	163	fprintf(stderr, "Timeout waiting for v1.x card\n");
kenjiArai	0:dc3be3264d2d	164	return SDCARD_FAIL;
kenjiArai	0:dc3be3264d2d	165	}
kenjiArai	0:dc3be3264d2d	166
kenjiArai	0:dc3be3264d2d	167	int SDFileSystem::initialise_card_v2() {
kenjiArai	0:dc3be3264d2d	168
kenjiArai	0:dc3be3264d2d	169	for(int i=0; i<SD_COMMAND_TIMEOUT; i++) {
kenjiArai	0:dc3be3264d2d	170	_cmd(55, 0);
kenjiArai	0:dc3be3264d2d	171	if(_cmd(41, 0) == 0) {
kenjiArai	0:dc3be3264d2d	172	_cmd58();
kenjiArai	0:dc3be3264d2d	173	return SDCARD_V2;
kenjiArai	0:dc3be3264d2d	174	}
kenjiArai	0:dc3be3264d2d	175	}
kenjiArai	0:dc3be3264d2d	176
kenjiArai	0:dc3be3264d2d	177	fprintf(stderr, "Timeout waiting for v2.x card\n");
kenjiArai	0:dc3be3264d2d	178	return SDCARD_FAIL;
kenjiArai	0:dc3be3264d2d	179	}
kenjiArai	0:dc3be3264d2d	180
kenjiArai	0:dc3be3264d2d	181	int SDFileSystem::disk_initialize() {
kenjiArai	0:dc3be3264d2d	182
kenjiArai	0:dc3be3264d2d	183	int i = initialise_card();
kenjiArai	0:dc3be3264d2d	184	// printf("init card = %d\n", i);
kenjiArai	0:dc3be3264d2d	185	// printf("OK\n");
kenjiArai	0:dc3be3264d2d	186
kenjiArai	0:dc3be3264d2d	187	_sectors = _sd_sectors();
kenjiArai	0:dc3be3264d2d	188
kenjiArai	0:dc3be3264d2d	189	// Set block length to 512 (CMD16)
kenjiArai	0:dc3be3264d2d	190	if(_cmd(16, 512) != 0) {
kenjiArai	0:dc3be3264d2d	191	fprintf(stderr, "Set 512-byte block timed out\n");
kenjiArai	0:dc3be3264d2d	192	return 1;
kenjiArai	0:dc3be3264d2d	193	}
kenjiArai	0:dc3be3264d2d	194
kenjiArai	0:dc3be3264d2d	195	_spi.frequency(1000000); // Set to 1MHz for data transfer
kenjiArai	0:dc3be3264d2d	196	return 0;
kenjiArai	0:dc3be3264d2d	197	}
kenjiArai	0:dc3be3264d2d	198
kenjiArai	0:dc3be3264d2d	199	int SDFileSystem::disk_write(const char *buffer, int block_number) {
kenjiArai	0:dc3be3264d2d	200	// set write address for single block (CMD24)
kenjiArai	0:dc3be3264d2d	201	if(_cmd(24, block_number * 512) != 0) {
kenjiArai	0:dc3be3264d2d	202	return 1;
kenjiArai	0:dc3be3264d2d	203	}
kenjiArai	0:dc3be3264d2d	204
kenjiArai	0:dc3be3264d2d	205	// send the data block
kenjiArai	0:dc3be3264d2d	206	_write(buffer, 512);
kenjiArai	0:dc3be3264d2d	207	return 0;
kenjiArai	0:dc3be3264d2d	208	}
kenjiArai	0:dc3be3264d2d	209
kenjiArai	0:dc3be3264d2d	210	int SDFileSystem::disk_read(char *buffer, int block_number) {
kenjiArai	0:dc3be3264d2d	211	// set read address for single block (CMD17)
kenjiArai	0:dc3be3264d2d	212	if(_cmd(17, block_number * 512) != 0) {
kenjiArai	0:dc3be3264d2d	213	return 1;
kenjiArai	0:dc3be3264d2d	214	}
kenjiArai	0:dc3be3264d2d	215
kenjiArai	0:dc3be3264d2d	216	// receive the data
kenjiArai	0:dc3be3264d2d	217	_read(buffer, 512);
kenjiArai	0:dc3be3264d2d	218	return 0;
kenjiArai	0:dc3be3264d2d	219	}
kenjiArai	0:dc3be3264d2d	220
kenjiArai	0:dc3be3264d2d	221	int SDFileSystem::disk_status() { return 0; }
kenjiArai	0:dc3be3264d2d	222	int SDFileSystem::disk_sync() { return 0; }
kenjiArai	0:dc3be3264d2d	223	int SDFileSystem::disk_sectors() { return _sectors; }
kenjiArai	0:dc3be3264d2d	224
kenjiArai	0:dc3be3264d2d	225	// PRIVATE FUNCTIONS
kenjiArai	0:dc3be3264d2d	226
kenjiArai	0:dc3be3264d2d	227	int SDFileSystem::_cmd(int cmd, int arg) {
kenjiArai	0:dc3be3264d2d	228	_cs = 0;
kenjiArai	0:dc3be3264d2d	229
kenjiArai	0:dc3be3264d2d	230	// send a command
kenjiArai	0:dc3be3264d2d	231	_spi.write(0x40 \| cmd);
kenjiArai	0:dc3be3264d2d	232	_spi.write(arg >> 24);
kenjiArai	0:dc3be3264d2d	233	_spi.write(arg >> 16);
kenjiArai	0:dc3be3264d2d	234	_spi.write(arg >> 8);
kenjiArai	0:dc3be3264d2d	235	_spi.write(arg >> 0);
kenjiArai	0:dc3be3264d2d	236	_spi.write(0x95);
kenjiArai	0:dc3be3264d2d	237
kenjiArai	0:dc3be3264d2d	238	// wait for the repsonse (response[7] == 0)
kenjiArai	0:dc3be3264d2d	239	for(int i=0; i<SD_COMMAND_TIMEOUT; i++) {
kenjiArai	0:dc3be3264d2d	240	int response = _spi.write(0xFF);
kenjiArai	0:dc3be3264d2d	241	if(!(response & 0x80)) {
kenjiArai	0:dc3be3264d2d	242	_cs = 1;
kenjiArai	0:dc3be3264d2d	243	_spi.write(0xFF);
kenjiArai	0:dc3be3264d2d	244	return response;
kenjiArai	0:dc3be3264d2d	245	}
kenjiArai	0:dc3be3264d2d	246	}
kenjiArai	0:dc3be3264d2d	247	_cs = 1;
kenjiArai	0:dc3be3264d2d	248	_spi.write(0xFF);
kenjiArai	0:dc3be3264d2d	249	return -1; // timeout
kenjiArai	0:dc3be3264d2d	250	}
kenjiArai	0:dc3be3264d2d	251	int SDFileSystem::_cmdx(int cmd, int arg) {
kenjiArai	0:dc3be3264d2d	252	_cs = 0;
kenjiArai	0:dc3be3264d2d	253
kenjiArai	0:dc3be3264d2d	254	// send a command
kenjiArai	0:dc3be3264d2d	255	_spi.write(0x40 \| cmd);
kenjiArai	0:dc3be3264d2d	256	_spi.write(arg >> 24);
kenjiArai	0:dc3be3264d2d	257	_spi.write(arg >> 16);
kenjiArai	0:dc3be3264d2d	258	_spi.write(arg >> 8);
kenjiArai	0:dc3be3264d2d	259	_spi.write(arg >> 0);
kenjiArai	0:dc3be3264d2d	260	_spi.write(0x95);
kenjiArai	0:dc3be3264d2d	261
kenjiArai	0:dc3be3264d2d	262	// wait for the repsonse (response[7] == 0)
kenjiArai	0:dc3be3264d2d	263	for(int i=0; i<SD_COMMAND_TIMEOUT; i++) {
kenjiArai	0:dc3be3264d2d	264	int response = _spi.write(0xFF);
kenjiArai	0:dc3be3264d2d	265	if(!(response & 0x80)) {
kenjiArai	0:dc3be3264d2d	266	return response;
kenjiArai	0:dc3be3264d2d	267	}
kenjiArai	0:dc3be3264d2d	268	}
kenjiArai	0:dc3be3264d2d	269	_cs = 1;
kenjiArai	0:dc3be3264d2d	270	_spi.write(0xFF);
kenjiArai	0:dc3be3264d2d	271	return -1; // timeout
kenjiArai	0:dc3be3264d2d	272	}
kenjiArai	0:dc3be3264d2d	273
kenjiArai	0:dc3be3264d2d	274
kenjiArai	0:dc3be3264d2d	275	int SDFileSystem::_cmd58() {
kenjiArai	0:dc3be3264d2d	276	_cs = 0;
kenjiArai	0:dc3be3264d2d	277	int arg = 0;
kenjiArai	0:dc3be3264d2d	278
kenjiArai	0:dc3be3264d2d	279	// send a command
kenjiArai	0:dc3be3264d2d	280	_spi.write(0x40 \| 58);
kenjiArai	0:dc3be3264d2d	281	_spi.write(arg >> 24);
kenjiArai	0:dc3be3264d2d	282	_spi.write(arg >> 16);
kenjiArai	0:dc3be3264d2d	283	_spi.write(arg >> 8);
kenjiArai	0:dc3be3264d2d	284	_spi.write(arg >> 0);
kenjiArai	0:dc3be3264d2d	285	_spi.write(0x95);
kenjiArai	0:dc3be3264d2d	286
kenjiArai	0:dc3be3264d2d	287	// wait for the repsonse (response[7] == 0)
kenjiArai	0:dc3be3264d2d	288	for(int i=0; i<SD_COMMAND_TIMEOUT; i++) {
kenjiArai	0:dc3be3264d2d	289	int response = _spi.write(0xFF);
kenjiArai	0:dc3be3264d2d	290	if(!(response & 0x80)) {
kenjiArai	0:dc3be3264d2d	291	int ocr = _spi.write(0xFF) << 24;
kenjiArai	0:dc3be3264d2d	292	ocr \|= _spi.write(0xFF) << 16;
kenjiArai	0:dc3be3264d2d	293	ocr \|= _spi.write(0xFF) << 8;
kenjiArai	0:dc3be3264d2d	294	ocr \|= _spi.write(0xFF) << 0;
kenjiArai	0:dc3be3264d2d	295	// printf("OCR = 0x%08X\n", ocr);
kenjiArai	0:dc3be3264d2d	296	_cs = 1;
kenjiArai	0:dc3be3264d2d	297	_spi.write(0xFF);
kenjiArai	0:dc3be3264d2d	298	return response;
kenjiArai	0:dc3be3264d2d	299	}
kenjiArai	0:dc3be3264d2d	300	}
kenjiArai	0:dc3be3264d2d	301	_cs = 1;
kenjiArai	0:dc3be3264d2d	302	_spi.write(0xFF);
kenjiArai	0:dc3be3264d2d	303	return -1; // timeout
kenjiArai	0:dc3be3264d2d	304	}
kenjiArai	0:dc3be3264d2d	305
kenjiArai	0:dc3be3264d2d	306	int SDFileSystem::_cmd8() {
kenjiArai	0:dc3be3264d2d	307	_cs = 0;
kenjiArai	0:dc3be3264d2d	308
kenjiArai	0:dc3be3264d2d	309	// send a command
kenjiArai	0:dc3be3264d2d	310	_spi.write(0x40 \| 8); // CMD8
kenjiArai	0:dc3be3264d2d	311	_spi.write(0x00); // reserved
kenjiArai	0:dc3be3264d2d	312	_spi.write(0x00); // reserved
kenjiArai	0:dc3be3264d2d	313	_spi.write(0x01); // 3.3v
kenjiArai	0:dc3be3264d2d	314	_spi.write(0xAA); // check pattern
kenjiArai	0:dc3be3264d2d	315	_spi.write(0x87); // crc
kenjiArai	0:dc3be3264d2d	316
kenjiArai	0:dc3be3264d2d	317	// wait for the repsonse (response[7] == 0)
kenjiArai	0:dc3be3264d2d	318	for(int i=0; i<SD_COMMAND_TIMEOUT * 1000; i++) {
kenjiArai	0:dc3be3264d2d	319	char response[5];
kenjiArai	0:dc3be3264d2d	320	response[0] = _spi.write(0xFF);
kenjiArai	0:dc3be3264d2d	321	if(!(response[0] & 0x80)) {
kenjiArai	0:dc3be3264d2d	322	for(int j=1; j<5; j++) {
kenjiArai	0:dc3be3264d2d	323	response[i] = _spi.write(0xFF);
kenjiArai	0:dc3be3264d2d	324	}
kenjiArai	0:dc3be3264d2d	325	_cs = 1;
kenjiArai	0:dc3be3264d2d	326	_spi.write(0xFF);
kenjiArai	0:dc3be3264d2d	327	return response[0];
kenjiArai	0:dc3be3264d2d	328	}
kenjiArai	0:dc3be3264d2d	329	}
kenjiArai	0:dc3be3264d2d	330	_cs = 1;
kenjiArai	0:dc3be3264d2d	331	_spi.write(0xFF);
kenjiArai	0:dc3be3264d2d	332	return -1; // timeout
kenjiArai	0:dc3be3264d2d	333	}
kenjiArai	0:dc3be3264d2d	334
kenjiArai	0:dc3be3264d2d	335	int SDFileSystem::_read(char *buffer, int length) {
kenjiArai	0:dc3be3264d2d	336	_cs = 0;
kenjiArai	0:dc3be3264d2d	337
kenjiArai	0:dc3be3264d2d	338	// read until start byte (0xFF)
kenjiArai	0:dc3be3264d2d	339	while(_spi.write(0xFF) != 0xFE);
kenjiArai	0:dc3be3264d2d	340
kenjiArai	0:dc3be3264d2d	341	// read data
kenjiArai	0:dc3be3264d2d	342	for(int i=0; i<length; i++) {
kenjiArai	0:dc3be3264d2d	343	buffer[i] = _spi.write(0xFF);
kenjiArai	0:dc3be3264d2d	344	}
kenjiArai	0:dc3be3264d2d	345	_spi.write(0xFF); // checksum
kenjiArai	0:dc3be3264d2d	346	_spi.write(0xFF);
kenjiArai	0:dc3be3264d2d	347
kenjiArai	0:dc3be3264d2d	348	_cs = 1;
kenjiArai	0:dc3be3264d2d	349	_spi.write(0xFF);
kenjiArai	0:dc3be3264d2d	350	return 0;
kenjiArai	0:dc3be3264d2d	351	}
kenjiArai	0:dc3be3264d2d	352
kenjiArai	0:dc3be3264d2d	353	int SDFileSystem::_write(const char *buffer, int length) {
kenjiArai	0:dc3be3264d2d	354	_cs = 0;
kenjiArai	0:dc3be3264d2d	355
kenjiArai	0:dc3be3264d2d	356	// indicate start of block
kenjiArai	0:dc3be3264d2d	357	_spi.write(0xFE);
kenjiArai	0:dc3be3264d2d	358
kenjiArai	0:dc3be3264d2d	359	// write the data
kenjiArai	0:dc3be3264d2d	360	for(int i=0; i<length; i++) {
kenjiArai	0:dc3be3264d2d	361	_spi.write(buffer[i]);
kenjiArai	0:dc3be3264d2d	362	}
kenjiArai	0:dc3be3264d2d	363
kenjiArai	0:dc3be3264d2d	364	// write the checksum
kenjiArai	0:dc3be3264d2d	365	_spi.write(0xFF);
kenjiArai	0:dc3be3264d2d	366	_spi.write(0xFF);
kenjiArai	0:dc3be3264d2d	367
kenjiArai	0:dc3be3264d2d	368	// check the repsonse token
kenjiArai	0:dc3be3264d2d	369	if((_spi.write(0xFF) & 0x1F) != 0x05) {
kenjiArai	0:dc3be3264d2d	370	_cs = 1;
kenjiArai	0:dc3be3264d2d	371	_spi.write(0xFF);
kenjiArai	0:dc3be3264d2d	372	return 1;
kenjiArai	0:dc3be3264d2d	373	}
kenjiArai	0:dc3be3264d2d	374
kenjiArai	0:dc3be3264d2d	375	// wait for write to finish
kenjiArai	0:dc3be3264d2d	376	while(_spi.write(0xFF) == 0);
kenjiArai	0:dc3be3264d2d	377
kenjiArai	0:dc3be3264d2d	378	_cs = 1;
kenjiArai	0:dc3be3264d2d	379	_spi.write(0xFF);
kenjiArai	0:dc3be3264d2d	380	return 0;
kenjiArai	0:dc3be3264d2d	381	}
kenjiArai	0:dc3be3264d2d	382
kenjiArai	0:dc3be3264d2d	383	static int ext_bits(char *data, int msb, int lsb) {
kenjiArai	0:dc3be3264d2d	384	int bits = 0;
kenjiArai	0:dc3be3264d2d	385	int size = 1 + msb - lsb;
kenjiArai	0:dc3be3264d2d	386	for(int i=0; i<size; i++) {
kenjiArai	0:dc3be3264d2d	387	int position = lsb + i;
kenjiArai	0:dc3be3264d2d	388	int byte = 15 - (position >> 3);
kenjiArai	0:dc3be3264d2d	389	int bit = position & 0x7;
kenjiArai	0:dc3be3264d2d	390	int value = (data[byte] >> bit) & 1;
kenjiArai	0:dc3be3264d2d	391	bits \|= value << i;
kenjiArai	0:dc3be3264d2d	392	}
kenjiArai	0:dc3be3264d2d	393	return bits;
kenjiArai	0:dc3be3264d2d	394	}
kenjiArai	0:dc3be3264d2d	395
kenjiArai	0:dc3be3264d2d	396	int SDFileSystem::_sd_sectors() {
kenjiArai	0:dc3be3264d2d	397
kenjiArai	0:dc3be3264d2d	398	// CMD9, Response R2 (R1 byte + 16-byte block read)
kenjiArai	0:dc3be3264d2d	399	if(_cmdx(9, 0) != 0) {
kenjiArai	0:dc3be3264d2d	400	fprintf(stderr, "Didn't get a response from the disk\n");
kenjiArai	0:dc3be3264d2d	401	return 0;
kenjiArai	0:dc3be3264d2d	402	}
kenjiArai	0:dc3be3264d2d	403
kenjiArai	0:dc3be3264d2d	404	char csd[16];
kenjiArai	0:dc3be3264d2d	405	if(_read(csd, 16) != 0) {
kenjiArai	0:dc3be3264d2d	406	fprintf(stderr, "Couldn't read csd response from disk\n");
kenjiArai	0:dc3be3264d2d	407	return 0;
kenjiArai	0:dc3be3264d2d	408	}
kenjiArai	0:dc3be3264d2d	409
kenjiArai	0:dc3be3264d2d	410	// csd_structure : csd[127:126]
kenjiArai	0:dc3be3264d2d	411	// c_size : csd[73:62]
kenjiArai	0:dc3be3264d2d	412	// c_size_mult : csd[49:47]
kenjiArai	0:dc3be3264d2d	413	// read_bl_len : csd[83:80] - the maximum read block length
kenjiArai	0:dc3be3264d2d	414
kenjiArai	0:dc3be3264d2d	415	int csd_structure = ext_bits(csd, 127, 126);
kenjiArai	0:dc3be3264d2d	416	int c_size = ext_bits(csd, 73, 62);
kenjiArai	0:dc3be3264d2d	417	int c_size_mult = ext_bits(csd, 49, 47);
kenjiArai	0:dc3be3264d2d	418	int read_bl_len = ext_bits(csd, 83, 80);
kenjiArai	0:dc3be3264d2d	419
kenjiArai	0:dc3be3264d2d	420	// printf("CSD_STRUCT = %d\n", csd_structure);
kenjiArai	0:dc3be3264d2d	421
kenjiArai	0:dc3be3264d2d	422	if(csd_structure != 0) {
kenjiArai	0:dc3be3264d2d	423	fprintf(stderr, "This disk tastes funny! I only know about type 0 CSD structures\n");
kenjiArai	0:dc3be3264d2d	424	return 0;
kenjiArai	0:dc3be3264d2d	425	}
kenjiArai	0:dc3be3264d2d	426
kenjiArai	0:dc3be3264d2d	427	// memory capacity = BLOCKNR * BLOCK_LEN
kenjiArai	0:dc3be3264d2d	428	// where
kenjiArai	0:dc3be3264d2d	429	// BLOCKNR = (C_SIZE+1) * MULT
kenjiArai	0:dc3be3264d2d	430	// MULT = 2^(C_SIZE_MULT+2) (C_SIZE_MULT < 8)
kenjiArai	0:dc3be3264d2d	431	// BLOCK_LEN = 2^READ_BL_LEN, (READ_BL_LEN < 12)
kenjiArai	0:dc3be3264d2d	432
kenjiArai	0:dc3be3264d2d	433	int block_len = 1 << read_bl_len;
kenjiArai	0:dc3be3264d2d	434	int mult = 1 << (c_size_mult + 2);
kenjiArai	0:dc3be3264d2d	435	int blocknr = (c_size + 1) * mult;
kenjiArai	0:dc3be3264d2d	436	int capacity = blocknr * block_len;
kenjiArai	0:dc3be3264d2d	437
kenjiArai	0:dc3be3264d2d	438	int blocks = capacity / 512;
kenjiArai	0:dc3be3264d2d	439
kenjiArai	0:dc3be3264d2d	440	return blocks;
kenjiArai	0:dc3be3264d2d	441	}

Repository toolbox

Export to desktop IDE

Build repository

Repository details

Type:	Program
Mbed OS support:	Mbed 2 deprecated
Created:	17 Apr 2010
Imports:	81
Forks:	0
Commits:	1
Dependents:	0
Dependencies:	1
Followers:	4

SDFileSystem.cpp@0:dc3be3264d2d, 2010-04-17 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning