tama_p1.c 25 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687
  1. #include <furi.h>
  2. #include <gui/gui.h>
  3. #include <input/input.h>
  4. #include <storage/storage.h>
  5. #include <stdlib.h>
  6. #include <stm32wbxx_ll_tim.h>
  7. #include "tamalib/tamalib.h"
  8. #include "tama.h"
  9. #include "compiled/assets_icons.h"
  10. TamaApp* g_ctx;
  11. FuriMutex* g_state_mutex;
  12. bool portrait_mode = false;
  13. bool in_menu = false;
  14. int menu_cursor = 0;
  15. const int menu_items = 3;
  16. static const Icon* icons_list[] = {
  17. &I_icon_0,
  18. &I_icon_1,
  19. &I_icon_2,
  20. &I_icon_3,
  21. &I_icon_4,
  22. &I_icon_5,
  23. &I_icon_6,
  24. &I_icon_7,
  25. };
  26. // static void draw_landscape(Canvas* const canvas, void* cb_ctx)
  27. static void draw_landscape(Canvas* const canvas) {
  28. // FURI_LOG_D(TAG, "Drawing frame");
  29. // Calculate positioning
  30. uint16_t canv_width = canvas_width(canvas);
  31. uint16_t canv_height = canvas_height(canvas);
  32. uint16_t lcd_matrix_scaled_width = 32 * TAMA_SCREEN_SCALE_FACTOR;
  33. uint16_t lcd_matrix_scaled_height = 16 * TAMA_SCREEN_SCALE_FACTOR;
  34. // uint16_t lcd_matrix_top = 0;
  35. uint16_t lcd_matrix_top = (canv_height - lcd_matrix_scaled_height) / 2;
  36. uint16_t lcd_matrix_left = (canv_width - lcd_matrix_scaled_width) / 2;
  37. uint16_t lcd_icon_upper_top = lcd_matrix_top - TAMA_LCD_ICON_SIZE - TAMA_LCD_ICON_MARGIN;
  38. uint16_t lcd_icon_upper_left = lcd_matrix_left;
  39. uint16_t lcd_icon_lower_top = lcd_matrix_top + lcd_matrix_scaled_height + TAMA_LCD_ICON_MARGIN;
  40. uint16_t lcd_icon_lower_left = lcd_matrix_left;
  41. uint16_t lcd_icon_spacing_horiz =
  42. (lcd_matrix_scaled_width - (4 * TAMA_LCD_ICON_SIZE)) / 3 + TAMA_LCD_ICON_SIZE;
  43. uint16_t y = lcd_matrix_top;
  44. for(uint8_t row = 0; row < 16; ++row) {
  45. uint16_t x = lcd_matrix_left;
  46. uint32_t row_pixels = g_ctx->framebuffer[row];
  47. for(uint8_t col = 0; col < 32; ++col) {
  48. if(row_pixels & 1) {
  49. canvas_draw_box(canvas, x, y, TAMA_SCREEN_SCALE_FACTOR, TAMA_SCREEN_SCALE_FACTOR);
  50. }
  51. x += TAMA_SCREEN_SCALE_FACTOR;
  52. row_pixels >>= 1;
  53. }
  54. y += TAMA_SCREEN_SCALE_FACTOR;
  55. }
  56. // Start drawing icons
  57. uint8_t lcd_icons = g_ctx->icons;
  58. // Draw top icons
  59. y = lcd_icon_upper_top;
  60. // y = 64 - TAMA_LCD_ICON_SIZE;
  61. uint16_t x_ic = lcd_icon_upper_left;
  62. for(uint8_t i = 0; i < 4; ++i) {
  63. if(lcd_icons & 1) {
  64. canvas_draw_icon(canvas, x_ic, y, icons_list[i]);
  65. }
  66. // x_ic += TAMA_LCD_ICON_SIZE + 4;
  67. x_ic += lcd_icon_spacing_horiz;
  68. lcd_icons >>= 1;
  69. }
  70. // Draw bottom icons
  71. y = lcd_icon_lower_top;
  72. x_ic = lcd_icon_lower_left;
  73. for(uint8_t i = 4; i < 8; ++i) {
  74. // canvas_draw_frame(canvas, x_ic, y, TAMA_LCD_ICON_SIZE, TAMA_LCD_ICON_SIZE);
  75. if(lcd_icons & 1) {
  76. canvas_draw_icon(canvas, x_ic, y, icons_list[i]);
  77. }
  78. x_ic += lcd_icon_spacing_horiz;
  79. lcd_icons >>= 1;
  80. }
  81. }
  82. // static void draw_portrait(Canvas* const canvas, void* cb_ctx)
  83. static void draw_portrait(Canvas* const canvas) {
  84. // FURI_LOG_D(TAG, "Drawing frame");
  85. // Calculate positioning
  86. // uint16_t canv_width = canvas_width(canvas);
  87. uint16_t canv_height = canvas_height(canvas);
  88. uint16_t lcd_matrix_scaled_width = 32 * TAMA_SCREEN_SCALE_FACTOR;
  89. uint16_t lcd_matrix_scaled_height = 16 * TAMA_SCREEN_SCALE_FACTOR;
  90. // uint16_t lcd_matrix_top = 0;
  91. uint16_t lcd_matrix_top = (canv_height - lcd_matrix_scaled_height) / 2;
  92. // uint16_t lcd_matrix_left = (canv_width - lcd_matrix_scaled_width) / 2;
  93. uint16_t lcd_matrix_left = 64 - TAMA_LCD_ICON_SIZE;
  94. uint16_t lcd_icon_upper_left = lcd_matrix_left;
  95. uint16_t lcd_icon_lower_left = lcd_matrix_left;
  96. uint16_t lcd_icon_spacing_horiz =
  97. (lcd_matrix_scaled_width - (4 * TAMA_LCD_ICON_SIZE)) / 3 + TAMA_LCD_ICON_SIZE;
  98. uint16_t y = lcd_matrix_top; // 64
  99. for(uint8_t row = 0; row < 16; ++row) {
  100. uint16_t x = 128; // lcd_matrix_left
  101. uint32_t row_pixels = g_ctx->framebuffer[row];
  102. for(uint8_t col = 0; col < 32; ++col) {
  103. if(row_pixels & 1) {
  104. canvas_draw_box(
  105. canvas, y + 32, x - 66, TAMA_SCREEN_SCALE_FACTOR, TAMA_SCREEN_SCALE_FACTOR);
  106. }
  107. x -= TAMA_SCREEN_SCALE_FACTOR;
  108. row_pixels >>= 1;
  109. }
  110. y += TAMA_SCREEN_SCALE_FACTOR;
  111. }
  112. // Start drawing icons
  113. uint8_t lcd_icons = g_ctx->icons;
  114. // Draw top icons
  115. // y = lcd_icon_upper_top;
  116. y = 30;
  117. // y = 64 - TAMA_LCD_ICON_SIZE;
  118. uint16_t x_ic = lcd_icon_upper_left;
  119. // uint16_t x_ic = 64 - TAMA_LCD_ICON_SIZE;
  120. for(uint8_t i = 0; i < 4; ++i) {
  121. if(lcd_icons & 1) {
  122. canvas_draw_icon(canvas, y, x_ic, icons_list[i]);
  123. }
  124. x_ic -= lcd_icon_spacing_horiz; // TAMA_LCD_ICON_SIZE + 4;
  125. lcd_icons >>= 1;
  126. }
  127. // Draw bottom icons
  128. y = 84; // lcd_icon_lower_top
  129. x_ic = lcd_icon_lower_left; // 64 - TAMA_LCD_ICON_SIZE
  130. for(uint8_t i = 4; i < 8; ++i) {
  131. // canvas_draw_frame(canvas, x_ic, y, TAMA_LCD_ICON_SIZE, TAMA_LCD_ICON_SIZE);
  132. if(lcd_icons & 1) {
  133. canvas_draw_icon(canvas, y, x_ic, icons_list[i]);
  134. }
  135. x_ic -= lcd_icon_spacing_horiz;
  136. lcd_icons >>= 1;
  137. }
  138. }
  139. // static void draw_menu_portrait(Canvas* const canvas, void* cb_ctx) {}
  140. static void draw_menu_landscape(Canvas* const canvas) {
  141. canvas_draw_frame(canvas, 0, 0, 128, 64);
  142. canvas_draw_str_aligned(canvas, 64, 6, AlignCenter, AlignCenter, "Menu");
  143. canvas_draw_line(canvas, 0, 10, 128, 10);
  144. switch(menu_cursor) {
  145. case 0:
  146. canvas_draw_triangle(canvas, 4, 21, 6, 6, CanvasDirectionLeftToRight);
  147. break;
  148. case 1:
  149. canvas_draw_triangle(canvas, 4, 36, 6, 6, CanvasDirectionLeftToRight);
  150. break;
  151. case 2:
  152. canvas_draw_triangle(canvas, 4, 51, 6, 6, CanvasDirectionLeftToRight);
  153. break;
  154. }
  155. canvas_draw_str(canvas, 12, 25, "A+C (mute/change time)");
  156. if(portrait_mode) {
  157. canvas_draw_str(canvas, 12, 40, "Orientation: Portrait");
  158. } else {
  159. canvas_draw_str(canvas, 12, 40, "Orientation: Landscape");
  160. }
  161. canvas_draw_str(canvas, 12, 55, "Close menu");
  162. }
  163. static void tama_p1_draw_callback(Canvas* const canvas, void* cb_ctx) {
  164. furi_assert(cb_ctx);
  165. FuriMutex* const mutex = cb_ctx;
  166. if(furi_mutex_acquire(mutex, 25) != FuriStatusOk) return;
  167. if(g_ctx->rom == NULL) {
  168. canvas_set_font(canvas, FontPrimary);
  169. canvas_draw_str(canvas, 30, 30, "No ROM");
  170. } else if(g_ctx->halted) {
  171. canvas_set_font(canvas, FontPrimary);
  172. canvas_draw_str(canvas, 30, 30, "Halted");
  173. } else {
  174. if(in_menu) {
  175. if(portrait_mode) {
  176. // draw_menu_portrait(canvas);
  177. draw_menu_landscape(canvas);
  178. } else {
  179. draw_menu_landscape(canvas);
  180. }
  181. } else if(portrait_mode) {
  182. draw_portrait(canvas);
  183. } else {
  184. draw_landscape(canvas);
  185. }
  186. }
  187. furi_mutex_release(mutex);
  188. }
  189. static void tama_p1_input_callback(InputEvent* input_event, FuriMessageQueue* event_queue) {
  190. furi_assert(event_queue);
  191. TamaEvent event = {.type = EventTypeInput, .input = *input_event};
  192. furi_message_queue_put(event_queue, &event, FuriWaitForever);
  193. }
  194. static void tama_p1_update_timer_callback(FuriMessageQueue* event_queue) {
  195. furi_assert(event_queue);
  196. TamaEvent event = {.type = EventTypeTick};
  197. furi_message_queue_put(event_queue, &event, 0);
  198. }
  199. static void tama_p1_load_state() {
  200. state_t* state;
  201. uint8_t buf[4];
  202. bool error = false;
  203. state = tamalib_get_state();
  204. Storage* storage = furi_record_open(RECORD_STORAGE);
  205. File* file = storage_file_alloc(storage);
  206. if(storage_file_open(file, TAMA_SAVE_PATH, FSAM_READ, FSOM_OPEN_EXISTING)) {
  207. storage_file_read(file, &buf, 4);
  208. if(buf[0] != (uint8_t)STATE_FILE_MAGIC[0] || buf[1] != (uint8_t)STATE_FILE_MAGIC[1] ||
  209. buf[2] != (uint8_t)STATE_FILE_MAGIC[2] || buf[3] != (uint8_t)STATE_FILE_MAGIC[3]) {
  210. FURI_LOG_E(TAG, "FATAL: Wrong state file magic in \"%s\" !\n", TAMA_SAVE_PATH);
  211. error = true;
  212. }
  213. storage_file_read(file, &buf, 1);
  214. if(buf[0] != STATE_FILE_VERSION) {
  215. FURI_LOG_E(TAG, "FATAL: Unsupported version");
  216. error = true;
  217. }
  218. if(!error) {
  219. FURI_LOG_D(TAG, "Reading save.bin");
  220. storage_file_read(file, &buf, 2);
  221. *(state->pc) = buf[0] | ((buf[1] & 0x1F) << 8);
  222. storage_file_read(file, &buf, 2);
  223. *(state->x) = buf[0] | ((buf[1] & 0xF) << 8);
  224. storage_file_read(file, &buf, 2);
  225. *(state->y) = buf[0] | ((buf[1] & 0xF) << 8);
  226. storage_file_read(file, &buf, 1);
  227. *(state->a) = buf[0] & 0xF;
  228. storage_file_read(file, &buf, 1);
  229. *(state->b) = buf[0] & 0xF;
  230. storage_file_read(file, &buf, 1);
  231. *(state->np) = buf[0] & 0x1F;
  232. storage_file_read(file, &buf, 1);
  233. *(state->sp) = buf[0];
  234. storage_file_read(file, &buf, 1);
  235. *(state->flags) = buf[0] & 0xF;
  236. storage_file_read(file, &buf, 4);
  237. *(state->tick_counter) = buf[0] | (buf[1] << 8) | (buf[2] << 16) | (buf[3] << 24);
  238. storage_file_read(file, &buf, 4);
  239. *(state->clk_timer_timestamp) = buf[0] | (buf[1] << 8) | (buf[2] << 16) |
  240. (buf[3] << 24);
  241. storage_file_read(file, &buf, 4);
  242. *(state->prog_timer_timestamp) = buf[0] | (buf[1] << 8) | (buf[2] << 16) |
  243. (buf[3] << 24);
  244. storage_file_read(file, &buf, 1);
  245. *(state->prog_timer_enabled) = buf[0] & 0x1;
  246. storage_file_read(file, &buf, 1);
  247. *(state->prog_timer_data) = buf[0];
  248. storage_file_read(file, &buf, 1);
  249. *(state->prog_timer_rld) = buf[0];
  250. storage_file_read(file, &buf, 4);
  251. *(state->call_depth) = buf[0] | (buf[1] << 8) | (buf[2] << 16) | (buf[3] << 24);
  252. FURI_LOG_D(TAG, "Restoring Interupts");
  253. for(uint32_t i = 0; i < INT_SLOT_NUM; i++) {
  254. storage_file_read(file, &buf, 1);
  255. state->interrupts[i].factor_flag_reg = buf[0] & 0xF;
  256. storage_file_read(file, &buf, 1);
  257. state->interrupts[i].mask_reg = buf[0] & 0xF;
  258. storage_file_read(file, &buf, 1);
  259. state->interrupts[i].triggered = buf[0] & 0x1;
  260. }
  261. /* First 640 half bytes correspond to the RAM */
  262. FURI_LOG_D(TAG, "Restoring RAM");
  263. for(uint32_t i = 0; i < MEM_RAM_SIZE; i++) {
  264. storage_file_read(file, &buf, 1);
  265. SET_RAM_MEMORY(state->memory, i + MEM_RAM_ADDR, buf[0] & 0xF);
  266. }
  267. /* I/Os are from 0xF00 to 0xF7F */
  268. FURI_LOG_D(TAG, "Restoring I/O");
  269. for(uint32_t i = 0; i < MEM_IO_SIZE; i++) {
  270. storage_file_read(file, &buf, 1);
  271. SET_IO_MEMORY(state->memory, i + MEM_IO_ADDR, buf[0] & 0xF);
  272. }
  273. FURI_LOG_D(TAG, "Refreshing Hardware");
  274. tamalib_refresh_hw();
  275. }
  276. }
  277. storage_file_close(file);
  278. storage_file_free(file);
  279. furi_record_close(RECORD_STORAGE);
  280. }
  281. static void tama_p1_save_state() {
  282. // Saving state
  283. FURI_LOG_D(TAG, "Saving Gamestate");
  284. uint8_t buf[4];
  285. state_t* state;
  286. uint32_t offset = 0;
  287. state = tamalib_get_state();
  288. Storage* storage = furi_record_open(RECORD_STORAGE);
  289. File* file = storage_file_alloc(storage);
  290. if(storage_file_open(file, TAMA_SAVE_PATH, FSAM_WRITE, FSOM_CREATE_ALWAYS)) {
  291. buf[0] = (uint8_t)STATE_FILE_MAGIC[0];
  292. buf[1] = (uint8_t)STATE_FILE_MAGIC[1];
  293. buf[2] = (uint8_t)STATE_FILE_MAGIC[2];
  294. buf[3] = (uint8_t)STATE_FILE_MAGIC[3];
  295. offset += storage_file_write(file, &buf, sizeof(buf));
  296. buf[0] = STATE_FILE_VERSION & 0xFF;
  297. offset += storage_file_write(file, &buf, 1);
  298. buf[0] = *(state->pc) & 0xFF;
  299. buf[1] = (*(state->pc) >> 8) & 0x1F;
  300. offset += storage_file_write(file, &buf, 2);
  301. buf[0] = *(state->x) & 0xFF;
  302. buf[1] = (*(state->x) >> 8) & 0xF;
  303. offset += storage_file_write(file, &buf, 2);
  304. buf[0] = *(state->y) & 0xFF;
  305. buf[1] = (*(state->y) >> 8) & 0xF;
  306. offset += storage_file_write(file, &buf, 2);
  307. buf[0] = *(state->a) & 0xF;
  308. offset += storage_file_write(file, &buf, 1);
  309. buf[0] = *(state->b) & 0xF;
  310. offset += storage_file_write(file, &buf, 1);
  311. buf[0] = *(state->np) & 0x1F;
  312. offset += storage_file_write(file, &buf, 1);
  313. buf[0] = *(state->sp) & 0xFF;
  314. offset += storage_file_write(file, &buf, 1);
  315. buf[0] = *(state->flags) & 0xF;
  316. offset += storage_file_write(file, &buf, 1);
  317. buf[0] = *(state->tick_counter) & 0xFF;
  318. buf[1] = (*(state->tick_counter) >> 8) & 0xFF;
  319. buf[2] = (*(state->tick_counter) >> 16) & 0xFF;
  320. buf[3] = (*(state->tick_counter) >> 24) & 0xFF;
  321. offset += storage_file_write(file, &buf, sizeof(buf));
  322. buf[0] = *(state->clk_timer_timestamp) & 0xFF;
  323. buf[1] = (*(state->clk_timer_timestamp) >> 8) & 0xFF;
  324. buf[2] = (*(state->clk_timer_timestamp) >> 16) & 0xFF;
  325. buf[3] = (*(state->clk_timer_timestamp) >> 24) & 0xFF;
  326. offset += storage_file_write(file, &buf, sizeof(buf));
  327. buf[0] = *(state->prog_timer_timestamp) & 0xFF;
  328. buf[1] = (*(state->prog_timer_timestamp) >> 8) & 0xFF;
  329. buf[2] = (*(state->prog_timer_timestamp) >> 16) & 0xFF;
  330. buf[3] = (*(state->prog_timer_timestamp) >> 24) & 0xFF;
  331. offset += storage_file_write(file, &buf, sizeof(buf));
  332. buf[0] = *(state->prog_timer_enabled) & 0x1;
  333. offset += storage_file_write(file, &buf, 1);
  334. buf[0] = *(state->prog_timer_data) & 0xFF;
  335. offset += storage_file_write(file, &buf, 1);
  336. buf[0] = *(state->prog_timer_rld) & 0xFF;
  337. offset += storage_file_write(file, &buf, 1);
  338. buf[0] = *(state->call_depth) & 0xFF;
  339. buf[1] = (*(state->call_depth) >> 8) & 0xFF;
  340. buf[2] = (*(state->call_depth) >> 16) & 0xFF;
  341. buf[3] = (*(state->call_depth) >> 24) & 0xFF;
  342. offset += storage_file_write(file, &buf, sizeof(buf));
  343. for(uint32_t i = 0; i < INT_SLOT_NUM; i++) {
  344. buf[0] = state->interrupts[i].factor_flag_reg & 0xF;
  345. offset += storage_file_write(file, &buf, 1);
  346. buf[0] = state->interrupts[i].mask_reg & 0xF;
  347. offset += storage_file_write(file, &buf, 1);
  348. buf[0] = state->interrupts[i].triggered & 0x1;
  349. offset += storage_file_write(file, &buf, 1);
  350. }
  351. /* First 640 half bytes correspond to the RAM */
  352. for(uint32_t i = 0; i < MEM_RAM_SIZE; i++) {
  353. buf[0] = GET_RAM_MEMORY(state->memory, i + MEM_RAM_ADDR) & 0xF;
  354. offset += storage_file_write(file, &buf, 1);
  355. }
  356. /* I/Os are from 0xF00 to 0xF7F */
  357. for(uint32_t i = 0; i < MEM_IO_SIZE; i++) {
  358. buf[0] = GET_IO_MEMORY(state->memory, i + MEM_IO_ADDR) & 0xF;
  359. offset += storage_file_write(file, &buf, 1);
  360. }
  361. }
  362. storage_file_close(file);
  363. storage_file_free(file);
  364. furi_record_close(RECORD_STORAGE);
  365. FURI_LOG_D(TAG, "Finished Writing %lu", offset);
  366. }
  367. static int32_t tama_p1_worker(void* context) {
  368. bool running = true;
  369. FuriMutex* mutex = context;
  370. while(furi_mutex_acquire(mutex, FuriWaitForever) != FuriStatusOk) furi_delay_tick(1);
  371. cpu_sync_ref_timestamp();
  372. LL_TIM_EnableCounter(TIM2);
  373. tama_p1_load_state();
  374. while(running) {
  375. if(furi_thread_flags_get()) {
  376. running = false;
  377. } else {
  378. // FURI_LOG_D(TAG, "Stepping");
  379. // for (int i = 0; i < 100; ++i)
  380. tamalib_step();
  381. }
  382. }
  383. LL_TIM_DisableCounter(TIM2);
  384. furi_mutex_release(mutex);
  385. return 0;
  386. }
  387. static void tama_p1_init(TamaApp* const ctx) {
  388. g_ctx = ctx;
  389. memset(ctx, 0, sizeof(TamaApp));
  390. tama_p1_hal_init(&ctx->hal);
  391. // Load ROM
  392. Storage* storage = furi_record_open(RECORD_STORAGE);
  393. FileInfo fi;
  394. if(storage_common_stat(storage, TAMA_ROM_PATH, &fi) == FSE_OK) {
  395. File* rom_file = storage_file_alloc(storage);
  396. if(storage_file_open(rom_file, TAMA_ROM_PATH, FSAM_READ, FSOM_OPEN_EXISTING)) {
  397. ctx->rom = malloc((size_t)fi.size);
  398. uint8_t* buf_ptr = ctx->rom;
  399. size_t read = 0;
  400. while(read < fi.size) {
  401. size_t to_read = fi.size - read;
  402. if(to_read > UINT16_MAX) to_read = UINT16_MAX;
  403. uint16_t now_read = storage_file_read(rom_file, buf_ptr, (uint16_t)to_read);
  404. read += now_read;
  405. buf_ptr += now_read;
  406. }
  407. // Reorder endianess of ROM
  408. for(size_t i = 0; i < fi.size; i += 2) {
  409. uint8_t b = ctx->rom[i];
  410. ctx->rom[i] = ctx->rom[i + 1];
  411. ctx->rom[i + 1] = b & 0xF;
  412. }
  413. }
  414. storage_file_close(rom_file);
  415. storage_file_free(rom_file);
  416. }
  417. furi_record_close(RECORD_STORAGE);
  418. if(ctx->rom != NULL) {
  419. // Init TIM2
  420. // 64KHz
  421. LL_TIM_InitTypeDef tim_init = {
  422. .Prescaler = 999,
  423. .CounterMode = LL_TIM_COUNTERMODE_UP,
  424. .Autoreload = 0xFFFFFFFF,
  425. };
  426. LL_TIM_Init(TIM2, &tim_init);
  427. LL_TIM_SetClockSource(TIM2, LL_TIM_CLOCKSOURCE_INTERNAL);
  428. LL_TIM_DisableCounter(TIM2);
  429. LL_TIM_SetCounter(TIM2, 0);
  430. // Init TamaLIB
  431. tamalib_register_hal(&ctx->hal);
  432. tamalib_init((u12_t*)ctx->rom, NULL, 64000);
  433. tamalib_set_speed(1);
  434. // TODO: implement fast forwarding
  435. ctx->fast_forward_done = true;
  436. // Start stepping thread
  437. ctx->thread = furi_thread_alloc();
  438. furi_thread_set_name(ctx->thread, "TamaLIB");
  439. furi_thread_set_stack_size(ctx->thread, 1024);
  440. furi_thread_set_callback(ctx->thread, tama_p1_worker);
  441. furi_thread_set_context(ctx->thread, g_state_mutex);
  442. furi_thread_start(ctx->thread);
  443. }
  444. }
  445. static void tama_p1_deinit(TamaApp* const ctx) {
  446. if(ctx->rom != NULL) {
  447. tamalib_release();
  448. furi_thread_free(ctx->thread);
  449. free(ctx->rom);
  450. }
  451. }
  452. int32_t tama_p1_app(void* p) {
  453. UNUSED(p);
  454. TamaApp* ctx = malloc(sizeof(TamaApp));
  455. g_state_mutex = furi_mutex_alloc(FuriMutexTypeRecursive);
  456. tama_p1_init(ctx);
  457. FuriMessageQueue* event_queue = furi_message_queue_alloc(8, sizeof(TamaEvent));
  458. ViewPort* view_port = view_port_alloc();
  459. view_port_draw_callback_set(view_port, tama_p1_draw_callback, g_state_mutex);
  460. view_port_input_callback_set(view_port, tama_p1_input_callback, event_queue);
  461. Gui* gui = furi_record_open(RECORD_GUI);
  462. gui_add_view_port(gui, view_port, GuiLayerFullscreen);
  463. FuriTimer* timer =
  464. furi_timer_alloc(tama_p1_update_timer_callback, FuriTimerTypePeriodic, event_queue);
  465. furi_timer_start(timer, furi_kernel_get_tick_frequency() / 30);
  466. // portrait_mode = false;
  467. // in_menu = false;
  468. // menu_cursor = 2;
  469. for(bool running = true; running;) {
  470. TamaEvent event;
  471. FuriStatus event_status = furi_message_queue_get(event_queue, &event, FuriWaitForever);
  472. if(event_status == FuriStatusOk) {
  473. // Local override with acquired context
  474. if(furi_mutex_acquire(g_state_mutex, FuriWaitForever) != FuriStatusOk) continue;
  475. if(event.type == EventTypeTick) {
  476. // FURI_LOG_D(TAG, "EventTypeTick");
  477. view_port_update(view_port);
  478. } else if(event.type == EventTypeInput) {
  479. FURI_LOG_D(
  480. TAG,
  481. "EventTypeInput: %ld %d %d",
  482. event.input.sequence,
  483. event.input.key,
  484. event.input.type);
  485. InputType input_type = event.input.type;
  486. btn_state_t tama_btn_state = 0;
  487. if(input_type == InputTypePress)
  488. tama_btn_state = BTN_STATE_PRESSED;
  489. else if(input_type == InputTypeRelease)
  490. tama_btn_state = BTN_STATE_RELEASED;
  491. if(in_menu) {
  492. if(event.input.key == InputKeyUp && event.input.type == InputTypePress) {
  493. if(menu_cursor > 0) {
  494. menu_cursor -= 1;
  495. } else {
  496. menu_cursor = menu_items - 1;
  497. }
  498. } else if(event.input.key == InputKeyDown && event.input.type == InputTypePress) {
  499. if(menu_cursor < menu_items - 1) {
  500. menu_cursor += 1;
  501. } else {
  502. menu_cursor = 0;
  503. }
  504. } else if(event.input.key == InputKeyOk) {
  505. switch(menu_cursor) {
  506. case 0:
  507. // mute tamagotchi
  508. tamalib_set_button(BTN_LEFT, tama_btn_state);
  509. tamalib_set_button(BTN_RIGHT, tama_btn_state);
  510. break;
  511. case 1:
  512. // portrait_mode = true;
  513. if(event.input.type == InputTypePress) portrait_mode = !portrait_mode;
  514. break;
  515. case 2:
  516. default:
  517. in_menu = false;
  518. break;
  519. }
  520. } else if(event.input.key == InputKeyBack) {
  521. in_menu = false;
  522. }
  523. } else { // out of menu
  524. if(input_type == InputTypePress || input_type == InputTypeRelease) {
  525. if(portrait_mode) {
  526. if(event.input.key == InputKeyDown) {
  527. tamalib_set_button(BTN_LEFT, tama_btn_state);
  528. } else if(event.input.key == InputKeyOk) {
  529. tamalib_set_button(BTN_MIDDLE, tama_btn_state);
  530. } else if(event.input.key == InputKeyRight) {
  531. tamalib_set_button(BTN_MIDDLE, tama_btn_state);
  532. } else if(event.input.key == InputKeyUp) {
  533. tamalib_set_button(BTN_RIGHT, tama_btn_state);
  534. } else if(event.input.key == InputKeyLeft) {
  535. in_menu = true;
  536. } else if(
  537. event.input.key == InputKeyBack &&
  538. event.input.type == InputTypeShort) {
  539. tama_p1_save_state();
  540. }
  541. } else {
  542. if(event.input.key == InputKeyLeft) {
  543. tamalib_set_button(BTN_LEFT, tama_btn_state);
  544. } else if(event.input.key == InputKeyOk) {
  545. tamalib_set_button(BTN_MIDDLE, tama_btn_state);
  546. } else if(event.input.key == InputKeyDown) {
  547. tamalib_set_button(BTN_MIDDLE, tama_btn_state);
  548. } else if(event.input.key == InputKeyRight) {
  549. tamalib_set_button(BTN_RIGHT, tama_btn_state);
  550. } else if(event.input.key == InputKeyUp) {
  551. in_menu = true;
  552. } else if(
  553. event.input.key == InputKeyBack &&
  554. event.input.type == InputTypePress) {
  555. tama_p1_save_state();
  556. }
  557. }
  558. }
  559. }
  560. if(event.input.key == InputKeyBack && event.input.type == InputTypeLong &&
  561. !in_menu) {
  562. furi_timer_stop(timer);
  563. running = false;
  564. tama_p1_save_state();
  565. }
  566. }
  567. furi_mutex_release(g_state_mutex);
  568. } else {
  569. // Timeout
  570. // FURI_LOG_D(TAG, "Timed out");
  571. }
  572. }
  573. if(ctx->rom != NULL) {
  574. furi_thread_flags_set(furi_thread_get_id(ctx->thread), 1);
  575. furi_thread_join(ctx->thread);
  576. }
  577. furi_timer_free(timer);
  578. view_port_enabled_set(view_port, false);
  579. gui_remove_view_port(gui, view_port);
  580. furi_record_close(RECORD_GUI);
  581. view_port_free(view_port);
  582. furi_message_queue_free(event_queue);
  583. furi_mutex_free(g_state_mutex);
  584. tama_p1_deinit(ctx);
  585. free(ctx);
  586. return 0;
  587. }