sd-card-test.cpp 24 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848
  1. #include "app-template.h"
  2. #include "fatfs/ff.h"
  3. #include "stm32_adafruit_sd.h"
  4. #include "fnv1a-hash.h"
  5. // event enumeration type
  6. typedef uint8_t event_t;
  7. class SdTestState {
  8. public:
  9. // state data
  10. static const uint8_t lines_count = 6;
  11. const char* line[lines_count];
  12. // state initializer
  13. SdTestState() {
  14. for(uint8_t i = 0; i < lines_count; i++) {
  15. line[i] = "";
  16. }
  17. }
  18. };
  19. // events class
  20. class SdTestEvent {
  21. public:
  22. // events enum
  23. static const event_t EventTypeTick = 0;
  24. static const event_t EventTypeKey = 1;
  25. // payload
  26. union {
  27. InputEvent input;
  28. } value;
  29. // event type
  30. event_t type;
  31. };
  32. // our app derived from base AppTemplate class
  33. // with template variables <state, events>
  34. class SdTest : public AppTemplate<SdTestState, SdTestEvent> {
  35. public:
  36. // vars
  37. GpioPin* red_led_record;
  38. GpioPin* green_led_record;
  39. FATFS sd_fat_fs;
  40. char sd_path[6];
  41. const uint32_t benchmark_data_size = 4096;
  42. uint8_t* benchmark_data;
  43. // funcs
  44. void run();
  45. void render(Canvas* canvas);
  46. template <class T> void set_text(std::initializer_list<T> list);
  47. template <class T> void set_error(std::initializer_list<T> list);
  48. const char* fatfs_error_desc(FRESULT res);
  49. void wait_for_button(Input input_button);
  50. bool ask(Input input_button_cancel, Input input_button_ok);
  51. void blink_red();
  52. void set_red();
  53. void blink_green();
  54. // "tests"
  55. void detect_sd_card();
  56. void show_warning();
  57. void init_sd_card();
  58. bool is_sd_card_formatted();
  59. void ask_and_format_sd_card();
  60. void mount_sd_card();
  61. void format_sd_card();
  62. void get_sd_card_info();
  63. void prepare_benchmark_data();
  64. void free_benchmark_data();
  65. void write_benchmark();
  66. uint32_t write_benchmark_internal(const uint32_t size, const uint32_t tcount);
  67. void read_benchmark();
  68. uint32_t read_benchmark_internal(const uint32_t size, const uint32_t count, FIL* file);
  69. void hash_benchmark();
  70. };
  71. // start app
  72. void SdTest::run() {
  73. // create pin
  74. GpioPin red_led = led_gpio[0];
  75. GpioPin green_led = led_gpio[1];
  76. // TODO open record
  77. red_led_record = &red_led;
  78. green_led_record = &green_led;
  79. // configure pin
  80. gpio_init(red_led_record, GpioModeOutputOpenDrain);
  81. gpio_init(green_led_record, GpioModeOutputOpenDrain);
  82. app_ready();
  83. detect_sd_card();
  84. show_warning();
  85. init_sd_card();
  86. if(!is_sd_card_formatted()) {
  87. format_sd_card();
  88. } else {
  89. ask_and_format_sd_card();
  90. }
  91. mount_sd_card();
  92. get_sd_card_info();
  93. prepare_benchmark_data();
  94. write_benchmark();
  95. read_benchmark();
  96. hash_benchmark();
  97. free_benchmark_data();
  98. set_text({
  99. "test complete",
  100. "",
  101. "",
  102. "",
  103. "",
  104. "press BACK to exit",
  105. });
  106. wait_for_button(InputBack);
  107. exit();
  108. }
  109. // detect sd card insertion
  110. void SdTest::detect_sd_card() {
  111. const uint8_t str_buffer_size = 40;
  112. const uint8_t dots_animation_size = 4;
  113. char str_buffer[str_buffer_size];
  114. const char dots[dots_animation_size][4] = {"", ".", "..", "..."};
  115. uint8_t i = 0;
  116. // detect sd card pin
  117. while(!hal_gpio_read_sd_detect()) {
  118. delay(100);
  119. snprintf(str_buffer, str_buffer_size, "Waiting%s", dots[i]);
  120. set_text({static_cast<const char*>(str_buffer), "Please insert sd card"});
  121. if(i < (dots_animation_size - 1)) {
  122. i++;
  123. } else {
  124. i = 0;
  125. }
  126. }
  127. blink_green();
  128. }
  129. // show warning about test
  130. void SdTest::show_warning() {
  131. set_text(
  132. {"!!Warning!!",
  133. "during the tests",
  134. "card may be formatted",
  135. "or data on card may be lost",
  136. "",
  137. "press UP DOWN OK to continue"});
  138. wait_for_button(InputUp);
  139. wait_for_button(InputDown);
  140. wait_for_button(InputOk);
  141. }
  142. // init low level driver
  143. void SdTest::init_sd_card() {
  144. uint8_t bsp_result = BSP_SD_Init();
  145. // BSP_SD_OK = 0
  146. if(bsp_result) {
  147. set_error({"SD card init error", "BSP error"});
  148. }
  149. blink_green();
  150. }
  151. // test, if sd card need to be formatted
  152. bool SdTest::is_sd_card_formatted() {
  153. FRESULT result;
  154. set_text({"checking if card needs to be formatted"});
  155. result = f_mount(&sd_fat_fs, sd_path, 1);
  156. if(result == FR_NO_FILESYSTEM) {
  157. return false;
  158. } else {
  159. return true;
  160. }
  161. }
  162. void SdTest::ask_and_format_sd_card() {
  163. set_text({"Want to format sd card?", "", "", "", "", "LEFT to CANCEL | RIGHT to OK"});
  164. if(ask(InputLeft, InputRight)) {
  165. format_sd_card();
  166. }
  167. }
  168. // mount sd card
  169. void SdTest::mount_sd_card() {
  170. FRESULT result;
  171. set_text({"mounting sdcard"});
  172. result = f_mount(&sd_fat_fs, sd_path, 1);
  173. if(result) {
  174. set_error({"SD card mount error", fatfs_error_desc(result)});
  175. }
  176. blink_green();
  177. }
  178. // format sd card
  179. void SdTest::format_sd_card() {
  180. FRESULT result;
  181. BYTE* work_area;
  182. set_text({"formatting sdcard", "procedure can be lengthy", "please wait"});
  183. delay(100);
  184. work_area = static_cast<BYTE*>(malloc(_MAX_SS));
  185. if(work_area == NULL) {
  186. set_error({"SD card format error", "cannot allocate memory"});
  187. }
  188. result = f_mkfs(sd_path, (FM_FAT | FM_FAT32 | FM_EXFAT), 0, work_area, _MAX_SS);
  189. free(work_area);
  190. if(result) {
  191. set_error({"SD card format error", fatfs_error_desc(result)});
  192. }
  193. result = f_setlabel("Flipper SD");
  194. if(result) {
  195. set_error({"SD card set label error", fatfs_error_desc(result)});
  196. }
  197. blink_green();
  198. }
  199. // get info about sd card, label, sn
  200. // sector, cluster, total and free size
  201. void SdTest::get_sd_card_info() {
  202. const uint8_t str_buffer_size = 26;
  203. char str_buffer[4][str_buffer_size];
  204. char volume_label[128];
  205. DWORD serial_num;
  206. FRESULT result;
  207. FATFS* fs;
  208. DWORD free_clusters, free_sectors, total_sectors;
  209. // suppress "'%s' directive output may be truncated" warning about snprintf
  210. int __attribute__((unused)) snprintf_count = 0;
  211. // get label and s/n
  212. result = f_getlabel(sd_path, volume_label, &serial_num);
  213. if(result) set_error({"f_getlabel error", fatfs_error_desc(result)});
  214. snprintf_count = snprintf(str_buffer[0], str_buffer_size, "Label: %s", volume_label);
  215. snprintf(str_buffer[1], str_buffer_size, "S/N: %lu", serial_num);
  216. set_text(
  217. {static_cast<const char*>(str_buffer[0]),
  218. static_cast<const char*>(str_buffer[1]),
  219. "",
  220. "",
  221. "",
  222. "press OK to continue"});
  223. blink_green();
  224. wait_for_button(InputOk);
  225. // get total and free space
  226. result = f_getfree(sd_path, &free_clusters, &fs);
  227. if(result) set_error({"f_getfree error", fatfs_error_desc(result)});
  228. total_sectors = (fs->n_fatent - 2) * fs->csize;
  229. free_sectors = free_clusters * fs->csize;
  230. snprintf(str_buffer[0], str_buffer_size, "Cluster: %d sectors", fs->csize);
  231. snprintf(str_buffer[1], str_buffer_size, "Sector: %d bytes", fs->ssize);
  232. snprintf(str_buffer[2], str_buffer_size, "%lu KB total", total_sectors / 1024 * fs->ssize);
  233. snprintf(str_buffer[3], str_buffer_size, "%lu KB free", free_sectors / 1024 * fs->ssize);
  234. set_text(
  235. {static_cast<const char*>(str_buffer[0]),
  236. static_cast<const char*>(str_buffer[1]),
  237. static_cast<const char*>(str_buffer[2]),
  238. static_cast<const char*>(str_buffer[3]),
  239. "",
  240. "press OK to continue"});
  241. blink_green();
  242. wait_for_button(InputOk);
  243. }
  244. // prepare benchmark data (allocate data in ram)
  245. void SdTest::prepare_benchmark_data() {
  246. set_text({"preparing benchmark data"});
  247. benchmark_data = static_cast<uint8_t*>(malloc(benchmark_data_size));
  248. if(benchmark_data == NULL) {
  249. set_error({"cannot allocate buffer", "for benchmark data"});
  250. }
  251. for(size_t i = 0; i < benchmark_data_size; i++) {
  252. benchmark_data[i] = static_cast<uint8_t>(i);
  253. }
  254. set_text({"benchmark data prepared"});
  255. }
  256. void SdTest::free_benchmark_data() {
  257. free(benchmark_data);
  258. }
  259. // write speed test
  260. void SdTest::write_benchmark() {
  261. const uint32_t b1_size = 1;
  262. const uint32_t b8_size = 8;
  263. const uint32_t b32_size = 32;
  264. const uint32_t b256_size = 256;
  265. const uint32_t b4096_size = 4096;
  266. const uint32_t benchmark_data_size = 16384 * 4;
  267. uint32_t benchmark_bps = 0;
  268. const uint8_t str_buffer_size = 32;
  269. char str_buffer[6][str_buffer_size] = {"", "", "", "", "", ""};
  270. auto string_list = {
  271. static_cast<const char*>(str_buffer[0]),
  272. static_cast<const char*>(str_buffer[1]),
  273. static_cast<const char*>(str_buffer[2]),
  274. static_cast<const char*>(str_buffer[3]),
  275. static_cast<const char*>(str_buffer[4]),
  276. static_cast<const char*>(str_buffer[5])};
  277. set_text({"write speed test", "procedure can be lengthy", "please wait"});
  278. delay(100);
  279. // 1b test
  280. benchmark_bps = write_benchmark_internal(b1_size, benchmark_data_size / b1_size);
  281. snprintf(str_buffer[0], str_buffer_size, "1-byte: %lu bps", benchmark_bps);
  282. set_text(string_list);
  283. delay(100);
  284. // 8b test
  285. benchmark_bps = write_benchmark_internal(b8_size, benchmark_data_size / b8_size);
  286. snprintf(str_buffer[1], str_buffer_size, "8-byte: %lu bps", benchmark_bps);
  287. set_text(string_list);
  288. delay(100);
  289. // 32b test
  290. benchmark_bps = write_benchmark_internal(b32_size, benchmark_data_size / b32_size);
  291. snprintf(str_buffer[2], str_buffer_size, "32-byte: %lu bps", benchmark_bps);
  292. set_text(string_list);
  293. delay(100);
  294. // 256b test
  295. benchmark_bps = write_benchmark_internal(b256_size, benchmark_data_size / b256_size);
  296. snprintf(str_buffer[3], str_buffer_size, "256-byte: %lu bps", benchmark_bps);
  297. set_text(string_list);
  298. delay(100);
  299. // 4096b test
  300. benchmark_bps = write_benchmark_internal(b4096_size, benchmark_data_size / b4096_size);
  301. snprintf(str_buffer[4], str_buffer_size, "4096-byte: %lu bps", benchmark_bps);
  302. snprintf(str_buffer[5], str_buffer_size, "press OK to continue");
  303. set_text(string_list);
  304. blink_green();
  305. wait_for_button(InputOk);
  306. }
  307. uint32_t SdTest::write_benchmark_internal(const uint32_t size, const uint32_t count) {
  308. uint32_t start_tick, stop_tick, benchmark_bps, benchmark_time, bytes_written;
  309. FRESULT result;
  310. FIL file;
  311. const uint8_t str_buffer_size = 32;
  312. char str_buffer[str_buffer_size];
  313. result = f_open(&file, "write.test", FA_WRITE | FA_OPEN_ALWAYS);
  314. if(result) {
  315. snprintf(str_buffer, str_buffer_size, "in %lu-byte write test", size);
  316. set_error({"cannot open file ", static_cast<const char*>(str_buffer)});
  317. }
  318. start_tick = osKernelGetTickCount();
  319. for(size_t i = 0; i < count; i++) {
  320. result = f_write(&file, benchmark_data, size, reinterpret_cast<UINT*>(&bytes_written));
  321. if(bytes_written != size || result) {
  322. snprintf(str_buffer, str_buffer_size, "in %lu-byte write test", size);
  323. set_error({"cannot write to file ", static_cast<const char*>(str_buffer)});
  324. }
  325. }
  326. stop_tick = osKernelGetTickCount();
  327. result = f_close(&file);
  328. if(result) {
  329. snprintf(str_buffer, str_buffer_size, "in %lu-byte write test", size);
  330. set_error({"cannot close file ", static_cast<const char*>(str_buffer)});
  331. }
  332. benchmark_time = stop_tick - start_tick;
  333. benchmark_bps = (count * size) * osKernelGetTickFreq() / benchmark_time;
  334. return benchmark_bps;
  335. }
  336. // read speed test
  337. void SdTest::read_benchmark() {
  338. const uint32_t benchmark_data_size = 16384 * 8;
  339. uint32_t bytes_written;
  340. uint32_t benchmark_bps = 0;
  341. const uint8_t str_buffer_size = 32;
  342. char str_buffer[6][str_buffer_size] = {"", "", "", "", "", ""};
  343. auto string_list = {
  344. static_cast<const char*>(str_buffer[0]),
  345. static_cast<const char*>(str_buffer[1]),
  346. static_cast<const char*>(str_buffer[2]),
  347. static_cast<const char*>(str_buffer[3]),
  348. static_cast<const char*>(str_buffer[4]),
  349. static_cast<const char*>(str_buffer[5])};
  350. FRESULT result;
  351. FIL file;
  352. const uint32_t b1_size = 1;
  353. const uint32_t b8_size = 8;
  354. const uint32_t b32_size = 32;
  355. const uint32_t b256_size = 256;
  356. const uint32_t b4096_size = 4096;
  357. // prepare data for read test
  358. set_text({"prepare data", "for read speed test", "procedure can be lengthy", "please wait"});
  359. delay(100);
  360. result = f_open(&file, "read.test", FA_WRITE | FA_OPEN_ALWAYS);
  361. if(result) {
  362. set_error({"cannot open file ", "in prepare read"});
  363. }
  364. for(size_t i = 0; i < benchmark_data_size / b4096_size; i++) {
  365. result =
  366. f_write(&file, benchmark_data, b4096_size, reinterpret_cast<UINT*>(&bytes_written));
  367. if(bytes_written != b4096_size || result) {
  368. set_error({"cannot write to file ", "in prepare read"});
  369. }
  370. }
  371. result = f_close(&file);
  372. if(result) {
  373. set_error({"cannot close file ", "in prepare read"});
  374. }
  375. // test start
  376. set_text({"read speed test", "procedure can be lengthy", "please wait"});
  377. delay(100);
  378. // open file
  379. result = f_open(&file, "read.test", FA_READ | FA_OPEN_EXISTING);
  380. if(result) {
  381. set_error({"cannot open file ", "in read benchmark"});
  382. }
  383. // 1b test
  384. benchmark_bps = read_benchmark_internal(b1_size, benchmark_data_size / b1_size, &file);
  385. snprintf(str_buffer[0], str_buffer_size, "1-byte: %lu bps", benchmark_bps);
  386. set_text(string_list);
  387. delay(100);
  388. // 8b test
  389. benchmark_bps = read_benchmark_internal(b8_size, benchmark_data_size / b8_size, &file);
  390. snprintf(str_buffer[1], str_buffer_size, "8-byte: %lu bps", benchmark_bps);
  391. set_text(string_list);
  392. delay(100);
  393. // 32b test
  394. benchmark_bps = read_benchmark_internal(b32_size, benchmark_data_size / b32_size, &file);
  395. snprintf(str_buffer[2], str_buffer_size, "32-byte: %lu bps", benchmark_bps);
  396. set_text(string_list);
  397. delay(100);
  398. // 256b test
  399. benchmark_bps = read_benchmark_internal(b256_size, benchmark_data_size / b256_size, &file);
  400. snprintf(str_buffer[3], str_buffer_size, "256-byte: %lu bps", benchmark_bps);
  401. set_text(string_list);
  402. delay(100);
  403. // 4096b test
  404. benchmark_bps = read_benchmark_internal(b4096_size, benchmark_data_size / b4096_size, &file);
  405. snprintf(str_buffer[4], str_buffer_size, "4096-byte: %lu bps", benchmark_bps);
  406. snprintf(str_buffer[5], str_buffer_size, "press OK to continue");
  407. set_text(string_list);
  408. // close file
  409. result = f_close(&file);
  410. if(result) {
  411. set_error({"cannot close file ", "in read test"});
  412. }
  413. blink_green();
  414. wait_for_button(InputOk);
  415. }
  416. uint32_t SdTest::read_benchmark_internal(const uint32_t size, const uint32_t count, FIL* file) {
  417. uint32_t start_tick, stop_tick, benchmark_bps, benchmark_time, bytes_readed;
  418. FRESULT result;
  419. const uint8_t str_buffer_size = 32;
  420. char str_buffer[str_buffer_size];
  421. uint8_t* read_buffer;
  422. read_buffer = static_cast<uint8_t*>(malloc(size));
  423. if(read_buffer == NULL) {
  424. snprintf(str_buffer, str_buffer_size, "in %lu-byte read test", size);
  425. set_error({"cannot allocate memory", static_cast<const char*>(str_buffer)});
  426. }
  427. f_rewind(file);
  428. start_tick = osKernelGetTickCount();
  429. for(size_t i = 0; i < count; i++) {
  430. result = f_read(file, read_buffer, size, reinterpret_cast<UINT*>(&bytes_readed));
  431. if(bytes_readed != size || result) {
  432. snprintf(str_buffer, str_buffer_size, "in %lu-byte read test", size);
  433. set_error({"cannot read from file ", static_cast<const char*>(str_buffer)});
  434. }
  435. }
  436. stop_tick = osKernelGetTickCount();
  437. free(read_buffer);
  438. benchmark_time = stop_tick - start_tick;
  439. benchmark_bps = (count * size) * osKernelGetTickFreq() / benchmark_time;
  440. return benchmark_bps;
  441. }
  442. // hash benchmark, store data to sd with known hash
  443. // then read, calculate hash and compare both hashes
  444. void SdTest::hash_benchmark() {
  445. uint32_t mcu_data_hash = FNV_1A_INIT;
  446. uint32_t sdcard_data_hash = FNV_1A_INIT;
  447. uint8_t* read_buffer;
  448. uint32_t bytes_readed;
  449. uint32_t bytes_written;
  450. const uint8_t str_buffer_size = 32;
  451. char str_buffer[3][str_buffer_size] = {"", "", ""};
  452. FRESULT result;
  453. FIL file;
  454. const uint32_t b4096_size = 4096;
  455. const uint32_t benchmark_count = 20;
  456. // prepare data for hash test
  457. set_text({"prepare data", "for hash test"});
  458. delay(100);
  459. // write data to test file and calculate hash
  460. result = f_open(&file, "hash.test", FA_WRITE | FA_OPEN_ALWAYS);
  461. if(result) {
  462. set_error({"cannot open file ", "in prepare hash"});
  463. }
  464. for(uint32_t i = 0; i < benchmark_count; i++) {
  465. mcu_data_hash = fnv1a_buffer_hash(benchmark_data, b4096_size, mcu_data_hash);
  466. result =
  467. f_write(&file, benchmark_data, b4096_size, reinterpret_cast<UINT*>(&bytes_written));
  468. if(bytes_written != b4096_size || result) {
  469. set_error({"cannot write to file ", "in prepare hash"});
  470. }
  471. snprintf(str_buffer[0], str_buffer_size, "writing %lu of %lu x 4k", i, benchmark_count);
  472. set_text({"prepare data", "for hash test", static_cast<const char*>(str_buffer[0])});
  473. delay(100);
  474. }
  475. result = f_close(&file);
  476. if(result) {
  477. set_error({"cannot close file ", "in prepare hash"});
  478. }
  479. // show hash of data located in mcu memory
  480. snprintf(str_buffer[0], str_buffer_size, "hash in mcu 0x%lx", mcu_data_hash);
  481. set_text({str_buffer[0]});
  482. delay(100);
  483. // read data from sd card and calculate hash
  484. read_buffer = static_cast<uint8_t*>(malloc(b4096_size));
  485. if(read_buffer == NULL) {
  486. set_error({"cannot allocate memory", "in hash test"});
  487. }
  488. result = f_open(&file, "hash.test", FA_READ | FA_OPEN_EXISTING);
  489. if(result) {
  490. set_error({"cannot open file ", "in hash test"});
  491. }
  492. for(uint32_t i = 0; i < benchmark_count; i++) {
  493. result = f_read(&file, read_buffer, b4096_size, reinterpret_cast<UINT*>(&bytes_readed));
  494. sdcard_data_hash = fnv1a_buffer_hash(read_buffer, b4096_size, sdcard_data_hash);
  495. if(bytes_readed != b4096_size || result) {
  496. set_error({"cannot read from file ", "in hash test"});
  497. }
  498. snprintf(str_buffer[1], str_buffer_size, "reading %lu of %lu x 4k", i, benchmark_count);
  499. set_text({str_buffer[0], str_buffer[1]});
  500. delay(100);
  501. }
  502. result = f_close(&file);
  503. if(result) {
  504. set_error({"cannot close file ", "in hash test"});
  505. }
  506. free(read_buffer);
  507. snprintf(str_buffer[1], str_buffer_size, "hash in sdcard 0x%lx", sdcard_data_hash);
  508. if(mcu_data_hash == sdcard_data_hash) {
  509. snprintf(str_buffer[2], str_buffer_size, "hashes are equal, press OK");
  510. set_text(
  511. {static_cast<const char*>(str_buffer[0]),
  512. static_cast<const char*>(str_buffer[1]),
  513. "",
  514. "",
  515. "",
  516. static_cast<const char*>(str_buffer[2])});
  517. } else {
  518. snprintf(str_buffer[2], str_buffer_size, "hash error, press BACK to exit");
  519. set_error(
  520. {static_cast<const char*>(str_buffer[0]),
  521. static_cast<const char*>(str_buffer[1]),
  522. "",
  523. "",
  524. "",
  525. static_cast<const char*>(str_buffer[2])});
  526. }
  527. blink_green();
  528. wait_for_button(InputOk);
  529. }
  530. // wait for button press
  531. void SdTest::wait_for_button(Input input_button) {
  532. SdTestEvent event;
  533. osMessageQueueReset(event_queue);
  534. while(1) {
  535. osStatus_t result = osMessageQueueGet(event_queue, &event, NULL, osWaitForever);
  536. if(result == osOK && event.type == SdTestEvent::EventTypeKey) {
  537. if(event.value.input.state == true) {
  538. if(event.value.input.input == InputBack) {
  539. exit();
  540. } else {
  541. if(event.value.input.input == input_button) {
  542. blink_green();
  543. break;
  544. } else {
  545. blink_red();
  546. }
  547. }
  548. }
  549. }
  550. }
  551. osMessageQueueReset(event_queue);
  552. }
  553. // ask user to proceed or cancel
  554. bool SdTest::ask(Input input_button_cancel, Input input_button_ok) {
  555. bool return_result;
  556. SdTestEvent event;
  557. osMessageQueueReset(event_queue);
  558. while(1) {
  559. osStatus_t result = osMessageQueueGet(event_queue, &event, NULL, osWaitForever);
  560. if(result == osOK && event.type == SdTestEvent::EventTypeKey) {
  561. if(event.value.input.state == true) {
  562. if(event.value.input.input == InputBack) {
  563. exit();
  564. } else {
  565. if(event.value.input.input == input_button_ok) {
  566. blink_green();
  567. return_result = true;
  568. break;
  569. } else if(event.value.input.input == input_button_cancel) {
  570. blink_green();
  571. return_result = false;
  572. break;
  573. } else {
  574. blink_red();
  575. }
  576. }
  577. }
  578. }
  579. }
  580. osMessageQueueReset(event_queue);
  581. return return_result;
  582. }
  583. // blink red led
  584. void SdTest::blink_red() {
  585. gpio_write(red_led_record, 0);
  586. delay(50);
  587. gpio_write(red_led_record, 1);
  588. }
  589. // light up red led
  590. void SdTest::set_red() {
  591. gpio_write(red_led_record, 0);
  592. }
  593. // blink green led
  594. void SdTest::blink_green() {
  595. gpio_write(green_led_record, 0);
  596. delay(50);
  597. gpio_write(green_led_record, 1);
  598. }
  599. // FatFs errors descriptions
  600. const char* SdTest::fatfs_error_desc(FRESULT res) {
  601. switch(res) {
  602. case FR_OK:
  603. return "ok";
  604. break;
  605. case FR_DISK_ERR:
  606. return "low level error";
  607. break;
  608. case FR_INT_ERR:
  609. return "internal error";
  610. break;
  611. case FR_NOT_READY:
  612. return "not ready";
  613. break;
  614. case FR_NO_FILE:
  615. return "no file";
  616. break;
  617. case FR_NO_PATH:
  618. return "no path";
  619. break;
  620. case FR_INVALID_NAME:
  621. return "invalid name";
  622. break;
  623. case FR_DENIED:
  624. return "denied";
  625. break;
  626. case FR_EXIST:
  627. return "already exist";
  628. break;
  629. case FR_INVALID_OBJECT:
  630. return "invalid file/dir obj";
  631. break;
  632. case FR_WRITE_PROTECTED:
  633. return "write protected";
  634. break;
  635. case FR_INVALID_DRIVE:
  636. return "invalid drive";
  637. break;
  638. case FR_NOT_ENABLED:
  639. return "no work area in volume";
  640. break;
  641. case FR_NO_FILESYSTEM:
  642. return "no valid FS volume";
  643. break;
  644. case FR_MKFS_ABORTED:
  645. return "aborted, any problem";
  646. break;
  647. case FR_TIMEOUT:
  648. return "timeout";
  649. break;
  650. case FR_LOCKED:
  651. return "file locked";
  652. break;
  653. case FR_NOT_ENOUGH_CORE:
  654. return "not enough core memory";
  655. break;
  656. case FR_TOO_MANY_OPEN_FILES:
  657. return "too many open files";
  658. break;
  659. case FR_INVALID_PARAMETER:
  660. return "invalid parameter";
  661. break;
  662. default:
  663. return "unknown error";
  664. break;
  665. }
  666. }
  667. // set text, but with infinite loop
  668. template <class T> void SdTest::set_error(std::initializer_list<T> list) {
  669. set_text(list);
  670. set_red();
  671. wait_for_button(InputBack);
  672. exit();
  673. }
  674. // set text, sort of variadic function
  675. template <class T> void SdTest::set_text(std::initializer_list<T> list) {
  676. uint8_t line_position = 0;
  677. acquire_state();
  678. printf("------------------------\n");
  679. // set line strings from args
  680. for(auto element : list) {
  681. state.line[line_position] = element;
  682. printf("%s\n", element);
  683. line_position++;
  684. if(line_position == state.lines_count) break;
  685. }
  686. // set empty lines
  687. for(; line_position < state.lines_count; line_position++) {
  688. state.line[line_position] = "";
  689. printf("\n");
  690. }
  691. printf("------------------------\n");
  692. release_state();
  693. }
  694. // render app
  695. void SdTest::render(Canvas* canvas) {
  696. canvas_set_color(canvas, ColorBlack);
  697. canvas_set_font(canvas, FontSecondary);
  698. for(uint8_t i = 0; i < state.lines_count; i++) {
  699. canvas_draw_str(canvas, 0, (i + 1) * 10, state.line[i]);
  700. }
  701. }
  702. // app enter function
  703. extern "C" void sd_card_test(void* p) {
  704. SdTest* app = new SdTest();
  705. app->run();
  706. }