Momentum-Apps/bpmtapper/bpm.c

#include <furi.h>
#include <furi_hal.h>
#include <dialogs/dialogs.h>
#include <gui/gui.h>
#include <input/input.h>
#include <stdlib.h>
#include "bpm_tapper_icons.h"

typedef enum {
    EventTypeTick,
    EventTypeKey,
} EventType;

typedef struct {
    EventType type;
    InputEvent input;
} PluginEvent;

//QUEUE

struct node {
    int interval;
    struct node* next;
};
typedef struct node node;

typedef struct {
    int size;
    int max_size;
    node* front;
    node* rear;
} queue;

static void init_queue(queue* q) {
    q->size = 0;
    q->max_size = 8;
    q->front = NULL;
    q->rear = NULL;
}

static void queue_remove(queue* q) {
    node* tmp;
    tmp = q->front;
    q->front = q->front->next;
    q->size--;
    free(tmp);
}

static void queue_add(queue* q, int value) {
    node* tmp = malloc(sizeof(node));
    tmp->interval = value;
    tmp->next = NULL;
    if(q->size == q->max_size) {
        queue_remove(q);
    }
    // check if empty
    if(q->rear == NULL) {
        q->front = tmp;
        q->rear = tmp;
    } else {
        q->rear->next = tmp;
        q->rear = tmp;
    }
    q->size++;
}

static float queue_avg(queue* q) {
    float avg = 0.0;
    if(q->size == 0) {
        return avg;
    } else {
        node* tmp;
        float sum = 0.0;
        tmp = q->front;
        while(tmp != NULL) {
            sum = sum + tmp->interval;
            tmp = tmp->next;
        }
        avg = sum / q->size;
        FURI_LOG_D("BPM-Tapper", "Sum: %.2f Avg: %.2f", (double)sum, (double)avg);
        return avg;
    }
}

// TOO SLOW!
//uint64_t dolphin_state_timestamp() {
//    FuriHalRtcDateTime datetime;
//    furi_hal_rtc_get_datetime(&datetime);
//    return furi_hal_rtc_datetime_to_timestamp(&datetime);
//}
//
typedef struct {
    FuriMutex* mutex;
    int taps;
    double bpm;
    uint32_t last_stamp;
    uint32_t interval;
    queue* tap_queue;
} BPMTapper;

static void show_hello() {
    // BEGIN HELLO DIALOG
    DialogsApp* dialogs = furi_record_open(RECORD_DIALOGS);
    DialogMessage* message = dialog_message_alloc();

    const char* header_text = "BPM Tapper";
    const char* message_text = "Tap center to start";

    dialog_message_set_header(message, header_text, 63, 3, AlignCenter, AlignTop);
    dialog_message_set_text(message, message_text, 0, 17, AlignLeft, AlignTop);
    dialog_message_set_buttons(message, NULL, "Tap", NULL);

    dialog_message_set_icon(message, &I_DolphinCommon_56x48, 72, 17);

    dialog_message_show(dialogs, message);

    dialog_message_free(message);
    furi_record_close(RECORD_DIALOGS);
    // END HELLO DIALOG
}

static void input_callback(InputEvent* input_event, FuriMessageQueue* event_queue) {
    furi_assert(event_queue);

    PluginEvent event = {.type = EventTypeKey, .input = *input_event};
    furi_message_queue_put(event_queue, &event, FuriWaitForever);
}

static void render_callback(Canvas* const canvas, void* ctx) {
    furi_assert(ctx);
    const BPMTapper* bpm_state = ctx;
    furi_mutex_acquire(bpm_state->mutex, FuriWaitForever);

    FuriString* tempStr;
    // border
    //canvas_draw_frame(canvas, 0, 0, 128, 64);
    canvas_set_font(canvas, FontPrimary);

    tempStr = furi_string_alloc();

    furi_string_printf(tempStr, "Taps: %d", bpm_state->taps);
    canvas_draw_str_aligned(canvas, 5, 10, AlignLeft, AlignBottom, furi_string_get_cstr(tempStr));
    furi_string_reset(tempStr);

    furi_string_printf(tempStr, "Queue: %d", bpm_state->tap_queue->size);
    canvas_draw_str_aligned(canvas, 70, 10, AlignLeft, AlignBottom, furi_string_get_cstr(tempStr));
    furi_string_reset(tempStr);

    furi_string_printf(tempStr, "Interval: %ldms", bpm_state->interval);
    canvas_draw_str_aligned(canvas, 5, 20, AlignLeft, AlignBottom, furi_string_get_cstr(tempStr));
    furi_string_reset(tempStr);

    furi_string_printf(tempStr, "x2 %.2f /2 %.2f", bpm_state->bpm * 2, bpm_state->bpm / 2);
    canvas_draw_str_aligned(
        canvas, 64, 60, AlignCenter, AlignCenter, furi_string_get_cstr(tempStr));
    furi_string_reset(tempStr);

    furi_string_printf(tempStr, "%.2f", bpm_state->bpm);
    canvas_set_font(canvas, FontBigNumbers);
    canvas_draw_str_aligned(
        canvas, 64, 40, AlignCenter, AlignCenter, furi_string_get_cstr(tempStr));
    furi_string_reset(tempStr);

    furi_string_free(tempStr);

    furi_mutex_release(bpm_state->mutex);
}

static void bpm_state_init(BPMTapper* const plugin_state) {
    plugin_state->taps = 0;
    plugin_state->bpm = 120.0;
    plugin_state->last_stamp = 0; // furi_get_tick();
    plugin_state->interval = 0;
    queue* q;
    q = malloc(sizeof(queue));
    init_queue(q);
    plugin_state->tap_queue = q;
}

int32_t bpm_tapper_app(void* p) {
    UNUSED(p);

    FuriMessageQueue* event_queue = furi_message_queue_alloc(8, sizeof(PluginEvent));

    BPMTapper* bpm_state = malloc(sizeof(BPMTapper));
    // setup
    bpm_state_init(bpm_state);

    bpm_state->mutex = furi_mutex_alloc(FuriMutexTypeNormal);
    if(!bpm_state->mutex) {
        FURI_LOG_E("BPM-Tapper", "cannot create mutex\r\n");
        free(bpm_state);
        return 255;
    }
    show_hello();

    // BEGIN IMPLEMENTATION

    // Set system callbacks
    ViewPort* view_port = view_port_alloc();
    view_port_draw_callback_set(view_port, render_callback, bpm_state);
    view_port_input_callback_set(view_port, input_callback, event_queue);

    // Open GUI and register view_port
    Gui* gui = furi_record_open("gui");
    gui_add_view_port(gui, view_port, GuiLayerFullscreen);

    PluginEvent event;
    for(bool processing = true; processing;) {
        FuriStatus event_status = furi_message_queue_get(event_queue, &event, 100);
        furi_mutex_acquire(bpm_state->mutex, FuriWaitForever);
        if(event_status == FuriStatusOk) {
            // press events
            if(event.type == EventTypeKey) {
                if(event.input.type == InputTypePress) {
                    switch(event.input.key) {
                    case InputKeyUp:
                    case InputKeyDown:
                    case InputKeyRight:
                    case InputKeyLeft:
                    case InputKeyOk:
                        bpm_state->taps++;
                        uint32_t new_stamp = furi_get_tick();
                        if(bpm_state->last_stamp == 0) {
                            bpm_state->last_stamp = new_stamp;
                            break;
                        }
                        bpm_state->interval = new_stamp - bpm_state->last_stamp;
                        bpm_state->last_stamp = new_stamp;
                        queue_add(bpm_state->tap_queue, bpm_state->interval);
                        float avg = queue_avg(bpm_state->tap_queue);
                        float bps = 1.0 / (avg / 1000.0);
                        bpm_state->bpm = bps * 60.0;
                        break;
                    case InputKeyBack:
                        // Exit the plugin
                        processing = false;
                        break;
                    default:
                        break;
                    }
                }
            }
        }

        furi_mutex_release(bpm_state->mutex);
        view_port_update(view_port);
    }
    view_port_enabled_set(view_port, false);
    gui_remove_view_port(gui, view_port);
    furi_record_close("gui");
    view_port_free(view_port);
    furi_message_queue_free(event_queue);
    furi_mutex_free(bpm_state->mutex);
    queue* q = bpm_state->tap_queue;
    free(q);
    free(bpm_state);

    return 0;
}