sd-card-test.cpp 24 KB

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