Mercurial > ~darius > hgwebdir.cgi > stm32temp
annotate fatfs_sd.c @ 89:fc21fb5b171b default tip
Make error message more useful
author | Daniel O'Connor <darius@dons.net.au> |
---|---|
date | Fri, 13 Mar 2015 11:39:59 +1030 |
parents | 9521be9b391e |
children |
rev | line source |
---|---|
49
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
1 /* |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
2 * Glue between FatFS and the ST SDIO code |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
3 * |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
4 * Copyright (c) 2013 |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
5 * Daniel O'Connor <darius@dons.net.au>. All rights reserved. |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
6 * |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
7 * Redistribution and use in source and binary forms, with or without |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
8 * modification, are permitted provided that the following conditions |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
9 * are met: |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
10 * 1. Redistributions of source code must retain the above copyright |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
11 * notice, this list of conditions and the following disclaimer. |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
12 * 2. Redistributions in binary form must reproduce the above copyright |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
13 * notice, this list of conditions and the following disclaimer in the |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
14 * documentation and/or other materials provided with the distribution. |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
15 * |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
16 * THIS SOFTWARE IS PROVIDED BY AUTHOR AND CONTRIBUTORS ``AS IS'' AND |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
17 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
19 * ARE DISCLAIMED. IN NO EVENT SHALL AUTHOR OR CONTRIBUTORS BE LIABLE |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
20 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
21 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
22 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
23 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
24 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
26 * SUCH DAMAGE. |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
27 */ |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
28 |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
29 #include <assert.h> |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
30 #include <inttypes.h> |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
31 #include <stdio.h> |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
32 #include <stdint.h> |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
33 #include <stdlib.h> |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
34 #include <string.h> |
50
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
35 #include <time.h> |
49
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
36 |
50
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
37 #include "delay.h" |
49
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
38 #include "stm32f10x.h" |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
39 #include "stm32_eval_sdio_sd.h" |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
40 #include "diskio.h" |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
41 |
50
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
42 #if 0 |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
43 #define DEBUG(fmt, ...) printf("%s: " fmt, __FUNCTION__, ## __VA_ARGS__) |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
44 #else |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
45 #define DEBUG(...) |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
46 #endif |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
47 |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
48 char *sderr2str(SD_Error err); |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
49 void dump_buf(uint8_t *buf, uint32_t size); |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
50 |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
51 static SD_CardInfo cardinfo; |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
52 |
49
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
53 DSTATUS |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
54 disk_initialize(BYTE pdrv) { |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
55 SD_Error err; |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
56 |
50
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
57 DEBUG("disk_initialize(%d)\n", pdrv); |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
58 |
49
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
59 /* Only have 1 disk */ |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
60 if (pdrv != 0) |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
61 return STA_NOINIT; |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
62 |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
63 if ((err = SD_Init()) != SD_OK) { |
50
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
64 printf("Failed init: %s\n", sderr2str(err)); |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
65 return STA_NOINIT; |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
66 } |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
67 if ((err = SD_GetCardInfo(&cardinfo)) != SD_OK) { |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
68 printf("Get card info failed: %s\n", sderr2str(err)); |
49
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
69 return STA_NOINIT; |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
70 } |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
71 |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
72 return 0; |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
73 } |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
74 |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
75 DSTATUS |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
76 disk_status(BYTE pdrv) { |
50
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
77 DEBUG("disk_status(%d)\n", pdrv); |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
78 |
49
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
79 if (pdrv != 0) |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
80 return STA_NOINIT; |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
81 |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
82 return 0; |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
83 } |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
84 |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
85 DRESULT |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
86 disk_read(BYTE pdrv, BYTE *buff, DWORD sector, BYTE count) { |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
87 SD_Error err; |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
88 |
50
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
89 DEBUG("disk_read(%d, 0x%08x, %d, %d)\n", pdrv, buff, sector, count); |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
90 |
49
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
91 if (pdrv != 0) |
51
590886732da9
Return correct error defines.
Daniel O'Connor <darius@dons.net.au>
parents:
50
diff
changeset
|
92 return RES_ERROR; |
49
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
93 |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
94 if (count == 1) |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
95 err = SD_ReadBlock(buff, sector * SD_BLOCK_SIZE, SD_BLOCK_SIZE); |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
96 else |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
97 err = SD_ReadMultiBlocks(buff, sector * SD_BLOCK_SIZE, SD_BLOCK_SIZE, count); |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
98 |
50
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
99 #ifdef SD_DMA_MODE |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
100 if ((err = SD_WaitReadOperation()) != SD_OK) { |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
101 printf("Wait returned %s\n", sderr2str(err)); |
51
590886732da9
Return correct error defines.
Daniel O'Connor <darius@dons.net.au>
parents:
50
diff
changeset
|
102 return RES_ERROR; |
50
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
103 } |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
104 #endif |
49
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
105 if (err != SD_OK) { |
50
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
106 printf("Read failed: %s\n", sderr2str(err)); |
51
590886732da9
Return correct error defines.
Daniel O'Connor <darius@dons.net.au>
parents:
50
diff
changeset
|
107 return RES_ERROR; |
49
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
108 } |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
109 |
50
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
110 while(SD_GetStatus() != SD_TRANSFER_OK) |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
111 ; |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
112 |
49
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
113 return RES_OK; |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
114 } |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
115 |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
116 DRESULT |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
117 disk_write(BYTE pdrv, const BYTE *buff, DWORD sector, BYTE count) { |
50
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
118 SD_Error err; |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
119 |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
120 DEBUG("disk_write(%d, 0x%08x, %d, %d)\n", pdrv, buff, sector, count); |
49
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
121 if (pdrv != 0) |
51
590886732da9
Return correct error defines.
Daniel O'Connor <darius@dons.net.au>
parents:
50
diff
changeset
|
122 return RES_ERROR; |
50
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
123 |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
124 if (count == 1) |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
125 err = SD_WriteBlock(buff, sector * SD_BLOCK_SIZE, SD_BLOCK_SIZE); |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
126 else |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
127 err = SD_WriteMultiBlocks(buff, sector * SD_BLOCK_SIZE, SD_BLOCK_SIZE, count); |
49
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
128 |
50
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
129 #ifdef SD_DMA_MODE |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
130 if ((err = SD_WaitReadOperation()) != SD_OK) { |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
131 printf("Wait returned %s\n", sderr2str(err)); |
51
590886732da9
Return correct error defines.
Daniel O'Connor <darius@dons.net.au>
parents:
50
diff
changeset
|
132 return RES_ERROR; |
50
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
133 } |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
134 #endif |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
135 if (err != SD_OK) { |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
136 printf("Write failed: %s\n", sderr2str(err)); |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
137 return RES_ERROR; |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
138 } |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
139 |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
140 while(SD_GetStatus() != SD_TRANSFER_OK) |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
141 ; |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
142 |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
143 return RES_OK; |
49
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
144 } |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
145 |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
146 DRESULT |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
147 disk_ioctl(BYTE pdrv, BYTE cmd, void *buff) { |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
148 WORD *wd; |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
149 DWORD *dwd; |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
150 |
50
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
151 DEBUG("disk_ioctl(%d, %d, ...)\n", pdrv, cmd); |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
152 |
49
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
153 wd = buff; |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
154 dwd = buff; |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
155 |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
156 if (pdrv != 0) |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
157 return STA_NOINIT; |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
158 switch (cmd) { |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
159 case CTRL_SYNC: |
50
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
160 DEBUG("Sync\n"); |
49
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
161 break; |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
162 |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
163 case GET_SECTOR_SIZE: |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
164 *wd = SD_BLOCK_SIZE; |
50
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
165 DEBUG("Get sector size (%d)\n", *wd); |
49
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
166 break; |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
167 |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
168 case GET_SECTOR_COUNT: |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
169 *dwd = cardinfo.CardCapacity / SD_BLOCK_SIZE; |
50
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
170 DEBUG("Get sector count (%d)\n", *dwd); |
49
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
171 break; |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
172 |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
173 case GET_BLOCK_SIZE: |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
174 /* FatFS wants log2(blocksize) */ |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
175 *dwd = 0; |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
176 while (cardinfo.CardBlockSize > 0) { |
50
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
177 *dwd = *dwd + 1; |
49
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
178 cardinfo.CardBlockSize >>= 1; |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
179 } |
50
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
180 DEBUG("Get block size (%d)\n", *dwd); |
49
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
181 break; |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
182 |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
183 case CTRL_ERASE_SECTOR: |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
184 return RES_ERROR; |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
185 } |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
186 |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
187 return RES_OK; |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
188 |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
189 } |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
190 |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
191 /* |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
192 bit 31:25 Year from 1980 (0..127) |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
193 bit 24:21 Month (1..12) |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
194 bit 20:16 Day in month(1..31) |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
195 bit 15:11 Hour (0..23) |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
196 bit 10: 5 Minute (0..59) |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
197 bit 4: 0 Second / 2 (0..29) |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
198 */ |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
199 DWORD |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
200 get_fattime(void) { |
50
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
201 struct tm now; |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
202 time_t t; |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
203 DWORD res; |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
204 |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
205 t = time(NULL); |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
206 localtime_r(&t, &now); |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
207 res = ((now.tm_year - 80) << 25 | |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
208 ((now.tm_mon + 1) << 21) | |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
209 (now.tm_mday << 16) | |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
210 (now.tm_hour << 11) | |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
211 (now.tm_min << 5) | |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
212 (now.tm_sec >> 1)); |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
213 |
d7207a9d3c3b
Add write support. LFN still broken though.
Daniel O'Connor <darius@dons.net.au>
parents:
49
diff
changeset
|
214 return res; |
49
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
215 } |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
216 |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
217 void * |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
218 ff_memalloc(UINT msize) { |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
219 return malloc(msize); |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
220 } |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
221 |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
222 void |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
223 ff_memfree(void *mblock) { |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
224 free(mblock); |
ace431a0d0f5
Add SDIO code poached from STM. Use FatFS to read from SD card.
Daniel O'Connor <darius@dons.net.au>
parents:
diff
changeset
|
225 } |