source: azure_iot_hub_riscv/trunk/asp_baseplatform/OBJ/K210_GCC/SDCARD/sdtest.c@ 453

Last change on this file since 453 was 453, checked in by coas-nagasima, 4 years ago

ファイルを追加
  • Property svn:eol-style set to native
  • Property svn:mime-type set to text/x-csrc;charset=UTF-8
File size: 9.5 KB
Line 
1/*
2 * TOPPERS/ASP Kernel
3 * Toyohashi Open Platform for Embedded Real-Time Systems/
4 * Advanced Standard Profile Kernel
5 *
6 * Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
7 * Toyohashi Univ. of Technology, JAPAN
8 * Copyright (C) 2004-2012 by Embedded and Real-Time Systems Laboratory
9 * Graduate School of Information Science, Nagoya Univ., JAPAN
10 *
11 * 上記著作権者は，以下の(1)～(4)の条件を満たす場合に限り，本ソフトウェ
12 * ア（本ソフトウェアを改変したものを含む．以下同じ）を使用・複製・改
13 * 変・再配布（以下，利用と呼ぶ）することを無償で許諾する．
14 * (1) 本ソフトウェアをソースコードの形で利用する場合には，上記の著作
15 * 権表示，この利用条件および下記の無保証規定が，そのままの形でソー
16 * スコード中に含まれていること．
17 * (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
18 * 用できる形で再配布する場合には，再配布に伴うドキュメント（利用
19 * 者マニュアルなど）に，上記の著作権表示，この利用条件および下記
20 * の無保証規定を掲載すること．
21 * (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
22 * 用できない形で再配布する場合には，次のいずれかの条件を満たすこ
23 * と．
24 * (a) 再配布に伴うドキュメント（利用者マニュアルなど）に，上記の著
25 * 作権表示，この利用条件および下記の無保証規定を掲載すること．
26 * (b) 再配布の形態を，別に定める方法によって，TOPPERSプロジェクトに
27 * 報告すること．
28 * (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
29 * 害からも，上記著作権者およびTOPPERSプロジェクトを免責すること．
30 * また，本ソフトウェアのユーザまたはエンドユーザからのいかなる理
31 * 由に基づく請求からも，上記著作権者およびTOPPERSプロジェクトを
32 * 免責すること．
33 *
34 * 本ソフトウェアは，無保証で提供されているものである．上記著作権者お
35 * よびTOPPERSプロジェクトは，本ソフトウェアに関して，特定の使用目的
36 * に対する適合性も含めて，いかなる保証も行わない．また，本ソフトウェ
37 * アの利用により直接的または間接的に生じたいかなる損害に関しても，そ
38 * の責任を負わない．
39 *
40 * $Id$
41 */
42
43/*
44 * SD-CARDテストの本体
45 */
46
47#include <kernel.h>
48#include <t_syslog.h>
49#include <t_stdlib.h>
50#include <stdio.h>
51#include <string.h>
52#include <target_syssvc.h>
53#include "syssvc/serial.h"
54#include "syssvc/syslog.h"
55#include "kernel_cfg.h"
56#include "device.h"
57#include "spi.h"
58#include "spi_driver.h"
59#ifdef SDEV_SENSE_ONETIME
60#include "storagedevice.h"
61#include "sddiskio.h"
62#endif
63#include "sdtest.h"
64
65/*
66 * サービスコールのエラーのログ出力
67 */
68Inline void
69svc_perror(const char *file, int_t line, const char *expr, ER ercd)
70{
71 if (ercd < 0) {
72 t_perror(LOG_ERROR, file, line, expr, ercd);
73 }
74}
75
76#define SVC_PERROR(expr) svc_perror(__FILE__, __LINE__, #expr, (expr))
77
78
79static uint32_t heap_area[16*1024];
80
81intptr_t heap_param[2] = {
82 (intptr_t)heap_area,
83 (4*16*1024)
84};
85
86uint8_t sdbuffer[512];
87
88/*
89 * SW1割込み
90 */
91void sw_int(int arg)
92{
93 syslog_1(LOG_NOTICE, "## sw_int(%d) ##", arg);
94}
95
96void
97pinMode(uint8_t Pin, uint8_t dwMode){
98 int gpionum = gpio_get_gpiohno(Pin, false);
99 GPIO_Init_t init = {0};
100
101 syslog_2(LOG_NOTICE, "## pinMode Pin(%d) gpionum(%d) ##", Pin, gpionum);
102 if(gpionum >= 0){
103 uint8_t function = FUNC_GPIOHS0 + gpionum;
104 fpioa_set_function(Pin, function);
105 switch(dwMode){
106 case INPUT:
107 init.mode = GPIO_MODE_INPUT;
108 init.pull = GPIO_NOPULL;
109 break;
110 case INPUT_PULLDOWN:
111 init.mode = GPIO_MODE_INPUT;
112 init.pull = GPIO_PULLDOWN;
113 break;
114 case INPUT_PULLUP:
115 init.mode = GPIO_MODE_INPUT;
116 init.pull = GPIO_PULLUP;
117 break;
118 case OUTPUT:
119 default:
120 init.mode = GPIO_MODE_OUTPUT;
121 init.pull = GPIO_PULLDOWN;
122 break;
123 }
124 gpio_setup(TADR_GPIOHS_BASE, &init, (uint8_t)gpionum);
125 }
126 return ;
127}
128
129void
130digitalWrite(uint8_t Pin, int dwVal){
131 int8_t gpio_pin = gpio_get_gpiohno(Pin, false);
132
133 if( gpio_pin >= 0){
134 gpio_set_pin(TADR_GPIOHS_BASE, (uint8_t)gpio_pin, dwVal);
135 }
136}
137
138
139/*
140 * メインタスク
141 */
142void main_task(intptr_t exinf)
143{
144#ifdef SDEV_SENSE_ONETIME
145 StorageDevice_t *psdev;
146#endif
147 SPI_Init_t Init;
148 SPI_Handle_t *hspi;
149 SDCARD_Handler_t *hsd = NULL;
150#ifndef SDEV_SENSE_ONETIME
151 SDCARD_CardInfo_t CardInfo;
152#endif
153 ER_UINT ercd;
154 int i;
155
156 SVC_PERROR(syslog_msk_log(LOG_UPTO(LOG_INFO), LOG_UPTO(LOG_EMERG)));
157 syslog(LOG_NOTICE, "Sample program starts (exinf = %d).", (int_t) exinf);
158
159 /*
160 * シリアルポートの初期化
161 *
162 * システムログタスクと同じシリアルポートを使う場合など，シリアル
163 * ポートがオープン済みの場合にはここでE_OBJエラーになるが，支障は
164 * ない．
165 */
166 ercd = serial_opn_por(TASK_PORTID);
167 if (ercd < 0 && MERCD(ercd) != E_OBJ) {
168 syslog(LOG_ERROR, "%s (%d) reported by `serial_opn_por'.",
169 itron_strerror(ercd), SERCD(ercd));
170 }
171 SVC_PERROR(serial_ctl_por(TASK_PORTID,
172 (IOCTL_CRLF | IOCTL_FCSND | IOCTL_FCRCV)));
173
174 dly_tsk(100);
175 syslog_0(LOG_NOTICE, "SPI SEND/RECV START");
176 pinMode(SPI_SS_PIN, OUTPUT);
177 digitalWrite(SPI_SS_PIN, HIGH);
178#if 1 /* ROI DEBUG */
179 dly_tsk(100);
180#endif /* ROI DEBUG */
181
182 /*##-1- Configure the SPI peripheral #######################################*/
183 /* Set the SPI parameters */
184 Init.WorkMode = SPI_WORK_MODE_0;
185 Init.FrameFormat = SPI_FF_STANDARD;
186 Init.DataSize = 8;
187 Init.Prescaler = 5000000;
188 Init.SignBit = 0;
189 Init.InstLength = 0;
190 Init.AddrLength = 0;
191 Init.WaitCycles = 0;
192 Init.IATransMode = SPI_AITM_STANDARD;
193 Init.SclkPin = SPI_SCK_PIN;
194 Init.MosiPin = SPI_MOSI_PIN;
195 Init.MisoPin = SPI_MISO_PIN;
196 Init.SsPin = -1;
197 Init.SsNo = -1;
198#ifdef USE_TXDMA*/
199 Init.TxDMAChannel = SPI_DMA2_CH;
200#else
201 Init.TxDMAChannel = -1;
202#endif
203 Init.RxDMAChannel = SPI_DMA1_CH;
204 Init.semid = SPITRN_SEM;
205 Init.semlock = SPILOCK_SEM;
206 Init.semdmaid = SPIDMATX_SEM;
207 hspi = spi_init(SPI_PORTID, &Init);
208 if(hspi == NULL){
209 syslog_0(LOG_ERROR, "SPI INIT ERROR");
210 slp_tsk();
211 }
212 sdcard_setspi2(SPISDCARD_PORTID, hspi, SPI_SS_PIN);
213
214 /*
215 * SD-CARD SPI通信設定
216 */
217 for(i = 0 ; i < 10 ; i++)
218 sdbuffer[i] = 0xff;
219 if((ercd = spi_transmit(hspi, (uint8_t*)sdbuffer, 10)) != E_OK){
220 /* Transfer error in transmission process */
221 syslog_1(LOG_NOTICE, "## call Error_Handler(2)(%d) ##", ercd);
222 }
223#if SPI_WAIT_TIME == 0
224 if((ercd = spi_wait(hspi, 100)) != E_OK){
225 syslog_0(LOG_NOTICE, "## call Error_Handler(3) ##");
226 }
227#endif
228 dly_tsk(100);
229
230#ifndef SDEV_SENSE_ONETIME
231 if(sdcard_init(SPISDCARD_PORTID)){
232 hsd = sdcard_open(SPISDCARD_PORTID);
233 syslog_1(LOG_NOTICE, "## card(%d) ##", hsd->cardtype);
234 SVC_PERROR(sdcard_checkCID(hsd));
235 SVC_PERROR(sdcard_sendCSD(hsd));
236 SVC_PERROR(sdcard_getcardinfo(hsd, &CardInfo));
237 SVC_PERROR(sdcard_configuration(hsd));
238 }
239#else
240 SDMSence_task(0);
241 psdev = SDMGetStorageDevice(SDCARD_DEVNO);
242 hsd = (SDCARD_Handler_t *)psdev->_sdev_local[1];
243#endif
244 if(hsd == NULL){
245 syslog_0(LOG_NOTICE, "SD-CARD INITIAL ERROR !");
246 slp_tsk();
247 }
248#ifndef SDEV_SENSE_ONETIME
249 if(hsd != NULL && hsd->hspi != NULL){
250 unsigned char *p;
251 int j, bpb;
252 int SecPerCls, Rsv, NumFat, Fsize, RootDirC, RootSec;
253 for(i = 0 ; i < 1 ; i++){
254 ercd = sdcard_blockread(hsd, sdbuffer, i*512, 512, 1);
255 syslog_3(LOG_NOTICE, "## ercd(%d) i(%d) sdbuffer[%08x] ##", ercd, i, sdbuffer);
256 dly_tsk(300);
257 p = (unsigned char *)sdbuffer;
258 if(i == 0){
259 if(p[0x36] == 'F' && p[0x37] == 'A' && p[0x38] == 'T')
260 bpb = 0;
261 else{
262 bpb = p[0x1c6];
263 bpb |= p[0x1c7]<<8;
264 bpb |= p[0x1c8]<<16;
265 bpb |= p[0x1c9]<<24;
266 }
267 }
268 printf("\nsec(%d) ", i);
269 for(j = 0 ; j < 512 ; j++){
270 if((j % 16) == 0)
271 printf("\n%03x ", j);
272 printf("%02x ", p[j]);
273 }
274 printf("\n");
275 }
276 syslog_1(LOG_NOTICE, "## bpb(%08x) ##", bpb);
277 if(bpb != 0){
278 ercd = sdcard_blockread(hsd, sdbuffer, bpb*512, 512, 1);
279 syslog_3(LOG_NOTICE, "## ercd(%d) i(%d) sdbuffer[%08x] ##", ercd, bpb, sdbuffer);
280 dly_tsk(300);
281 printf("\nsec(%d) ", bpb);
282 for(j = 0 ; j < 512 ; j++){
283 if((j % 16) == 0)
284 printf("\n%03x ", j);
285 printf("%02x ", p[j]);
286 }
287 printf("\n");
288 }
289 p = (unsigned char *)sdbuffer;
290 SecPerCls = p[13];
291 Rsv = p[14] + (p[15] << 8);
292 NumFat = p[16];
293 RootDirC = p[17] + (p[18]<<8);
294 Fsize = p[22] + (p[23] << 8);
295 syslog_4(LOG_NOTICE, "## SecPerCls(%d) Rsv(%d) NumFat(%d) RootDirC(%d) ##", SecPerCls, Rsv, NumFat, RootDirC);
296 RootSec = bpb + Rsv + (NumFat * Fsize);
297 syslog_2(LOG_NOTICE, "## Fsize(%d) RootSec(%d) ##", Fsize, RootSec);
298
299 for(i = 0 ; i < 2 ; i++){
300 ercd = sdcard_blockread(hsd, sdbuffer, (i+RootSec)*512, 512, 1);
301 syslog_3(LOG_NOTICE, "## ercd(%d) i(%d) sdbuffer[%08x] ##", ercd, (i+RootSec), sdbuffer);
302 dly_tsk(300);
303 p = (unsigned char *)sdbuffer;
304 printf("\nsec(%d) ", (i+RootSec));
305 for(j = 0 ; j < 512 ; j++){
306 if((j % 16) == 0)
307 printf("\n%03x ", j);
308 printf("%02x ", p[j]);
309 }
310 printf("\n");
311 }
312 }
313#endif
314 (void)(hsd);
315
316 syslog(LOG_NOTICE, "Sample program ends.");
317 slp_tsk();
318// SVC_PERROR(ext_ker());
319}
Note: See TracBrowser for help on using the repository browser.