bpm.c 6.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240
  1. #include <furi.h>
  2. #include <furi_hal.h>
  3. #include <dialogs/dialogs.h>
  4. #include <gui/gui.h>
  5. #include <input/input.h>
  6. #include <m-string.h>
  7. #include <stdlib.h>
  8. typedef enum {
  9. EventTypeTick,
  10. EventTypeKey,
  11. } EventType;
  12. typedef struct {
  13. EventType type;
  14. InputEvent input;
  15. } PluginEvent;
  16. typedef struct {
  17. int taps;
  18. double bpm;
  19. uint32_t last_stamp;
  20. uint32_t interval;
  21. } BPMTapper;
  22. //QUEUE
  23. struct node {
  24. int interval;
  25. struct node *next;
  26. };
  27. typedef struct node node;
  28. typedef struct {
  29. int size;
  30. int max_size;
  31. node *front;
  32. node *rear;
  33. } queue;
  34. static void init_queue(queue *q) {
  35. q->size = 0;
  36. q->max_size = 15;
  37. q->front = NULL;
  38. q->rear = NULL;
  39. }
  40. static void queue_remove(queue *q) {
  41. node *tmp;
  42. tmp = q->front;
  43. q->front = q->front->next;
  44. q->size--;
  45. free(tmp);
  46. }
  47. static void queue_add(queue *q, int value) {
  48. node *tmp = malloc(sizeof(node));
  49. tmp->interval = value;
  50. tmp->next = NULL;
  51. if (q->size == q->max_size) {
  52. queue_remove(q);
  53. } else {
  54. // check if empty
  55. if (q->rear == NULL) {
  56. q->front = tmp;
  57. } else {
  58. q->rear->next = tmp;
  59. }
  60. q->rear = tmp;
  61. q->size++;
  62. }
  63. }
  64. static float queue_avg(queue *q) {
  65. float avg = 0.0;
  66. if (q->size == 0){
  67. return avg;
  68. } else {
  69. node *tmp;
  70. int sum = 0;
  71. tmp = q->front;
  72. while (tmp != NULL) {
  73. sum = sum + tmp->interval;
  74. tmp = tmp->next;
  75. }
  76. avg = (float)sum / q->size;
  77. return avg;
  78. }
  79. }
  80. // TOO SLOW!
  81. //uint64_t dolphin_state_timestamp() {
  82. // FuriHalRtcDateTime datetime;
  83. // furi_hal_rtc_get_datetime(&datetime);
  84. // return furi_hal_rtc_datetime_to_timestamp(&datetime);
  85. //}
  86. static void show_hello() {
  87. // BEGIN HELLO DIALOG
  88. DialogsApp* dialogs = furi_record_open(RECORD_DIALOGS);
  89. DialogMessage* message = dialog_message_alloc();
  90. const char* header_text = "BPM Tapper";
  91. const char* message_text = "Tap center to start";
  92. dialog_message_set_header(message, header_text, 63, 3, AlignCenter, AlignTop);
  93. dialog_message_set_text(message, message_text, 0, 17, AlignLeft, AlignTop);
  94. dialog_message_set_buttons(message, NULL, "Tap", NULL);
  95. dialog_message_set_icon(message, &I_DolphinCommon_56x48, 72, 17);
  96. dialog_message_show(dialogs, message);
  97. dialog_message_free(message);
  98. furi_record_close(RECORD_DIALOGS);
  99. // END HELLO DIALOG
  100. }
  101. static void input_callback(InputEvent* input_event, FuriMessageQueue* event_queue) {
  102. furi_assert(event_queue);
  103. PluginEvent event = {.type = EventTypeKey, .input = *input_event};
  104. furi_message_queue_put(event_queue, &event, FuriWaitForever);
  105. }
  106. static void render_callback(Canvas* const canvas, void* ctx) {
  107. string_t tempStr;
  108. const BPMTapper* bpm_state = acquire_mutex((ValueMutex*)ctx, 25);
  109. if (bpm_state == NULL) {
  110. return;
  111. }
  112. // border
  113. //canvas_draw_frame(canvas, 0, 0, 128, 64);
  114. canvas_set_font(canvas, FontPrimary);
  115. string_init(tempStr);
  116. string_printf(tempStr, "Taps: %d", bpm_state->taps);
  117. canvas_draw_str_aligned(canvas, 5, 15, AlignLeft, AlignBottom, string_get_cstr(tempStr));
  118. string_reset(tempStr);
  119. string_printf(tempStr, "Interval: %dms", bpm_state->interval);
  120. canvas_draw_str_aligned(canvas, 5, 25, AlignLeft, AlignBottom, string_get_cstr(tempStr));
  121. string_reset(tempStr);
  122. string_printf(tempStr, "%.2f", bpm_state->bpm);
  123. canvas_set_font(canvas, FontBigNumbers);
  124. canvas_draw_str_aligned(canvas, 20, 50, AlignLeft, AlignBottom, string_get_cstr(tempStr));
  125. string_reset(tempStr);
  126. string_clear(tempStr);
  127. release_mutex((ValueMutex*)ctx, bpm_state);
  128. }
  129. static void bpm_state_init(BPMTapper* const plugin_state) {
  130. plugin_state->taps = 0;
  131. plugin_state->bpm = 120.0;
  132. plugin_state->last_stamp = 0;
  133. plugin_state->interval = 500;
  134. }
  135. int32_t bpm_tapper_app(void* p) {
  136. UNUSED(p);
  137. FuriMessageQueue* event_queue = furi_message_queue_alloc(8, sizeof(PluginEvent));
  138. BPMTapper* bpm_state = malloc(sizeof(BPMTapper));
  139. // setup
  140. bpm_state_init(bpm_state);
  141. ValueMutex state_mutex;
  142. if (!init_mutex(&state_mutex, bpm_state, sizeof(bpm_state))) {
  143. FURI_LOG_E("BPM-Tapper", "cannot create mutex\r\n");
  144. free(bpm_state);
  145. return 255;
  146. }
  147. show_hello();
  148. // BEGIN IMPLEMENTATION
  149. // Set system callbacks
  150. ViewPort* view_port = view_port_alloc();
  151. view_port_draw_callback_set(view_port, render_callback, &state_mutex);
  152. view_port_input_callback_set(view_port, input_callback, event_queue);
  153. // Open GUI and register view_port
  154. Gui* gui = furi_record_open("gui");
  155. gui_add_view_port(gui, view_port, GuiLayerFullscreen);
  156. PluginEvent event;
  157. for (bool processing = true; processing;) {
  158. FuriStatus event_status = furi_message_queue_get(event_queue, &event, 100);
  159. BPMTapper* bpm_state = (BPMTapper*)acquire_mutex_block(&state_mutex);
  160. if(event_status == FuriStatusOk) {
  161. // press events
  162. if(event.type == EventTypeKey) {
  163. if(event.input.type == InputTypePress) {
  164. switch(event.input.key) {
  165. case InputKeyUp:
  166. case InputKeyDown:
  167. case InputKeyRight:
  168. case InputKeyLeft:
  169. case InputKeyOk:
  170. bpm_state->taps++;
  171. uint32_t new_stamp = furi_get_tick();
  172. bpm_state->interval = new_stamp - bpm_state->last_stamp;
  173. bpm_state->last_stamp = new_stamp;
  174. float bps = 1.0 / (bpm_state->interval / 1000.0);
  175. bpm_state->bpm = bps * 60.0;
  176. break;
  177. case InputKeyBack:
  178. // Exit the plugin
  179. processing = false;
  180. break;
  181. }
  182. }
  183. }
  184. } else {
  185. FURI_LOG_D("BPM-Tapper", "FuriMessageQueue: event timeout");
  186. // event timeout
  187. }
  188. view_port_update(view_port);
  189. release_mutex(&state_mutex, bpm_state);
  190. }
  191. view_port_enabled_set(view_port, false);
  192. gui_remove_view_port(gui, view_port);
  193. furi_record_close("gui");
  194. view_port_free(view_port);
  195. furi_message_queue_free(event_queue);
  196. delete_mutex(&state_mutex);
  197. //free(bpm_state);
  198. return 0;
  199. }