unleashed-firmware/applications/bt/bt_service/bt.c

#include "bt_i.h"
#include "battery_service.h"

#define BT_SERVICE_TAG "BT"

// static void bt_update_statusbar(void* arg) {
//     furi_assert(arg);
//     Bt* bt = arg;
//     BtMessage m = {.type = BtMessageTypeUpdateStatusbar};
//     furi_check(osMessageQueuePut(bt->message_queue, &m, 0, osWaitForever) == osOK);
// }

static void bt_draw_statusbar_callback(Canvas* canvas, void* context) {
    canvas_draw_icon(canvas, 0, 0, &I_Bluetooth_5x8);
}

static ViewPort* bt_statusbar_view_port_alloc() {
    ViewPort* statusbar_view_port = view_port_alloc();
    view_port_set_width(statusbar_view_port, 5);
    view_port_draw_callback_set(statusbar_view_port, bt_draw_statusbar_callback, NULL);
    view_port_enabled_set(statusbar_view_port, false);
    return statusbar_view_port;
}

Bt* bt_alloc() {
    Bt* bt = furi_alloc(sizeof(Bt));
    // Load settings
    if(!bt_settings_load(&bt->bt_settings)) {
        bt_settings_save(&bt->bt_settings);
    }
    // Alloc queue
    bt->message_queue = osMessageQueueNew(8, sizeof(BtMessage), NULL);

    // doesn't make sense if we waiting for transition on service start
    // bt->update_status_timer = osTimerNew(bt_update_statusbar, osTimerPeriodic, bt, NULL);
    // osTimerStart(bt->update_status_timer, 4000);

    // Setup statusbar view port
    bt->statusbar_view_port = bt_statusbar_view_port_alloc();
    // Gui
    bt->gui = furi_record_open("gui");
    gui_add_view_port(bt->gui, bt->statusbar_view_port, GuiLayerStatusBarLeft);

    return bt;
}

bool bt_update_battery_level(Bt* bt, uint8_t battery_level) {
    BtMessage message = {
        .type = BtMessageTypeUpdateBatteryLevel, .data.battery_level = battery_level};
    return osMessageQueuePut(bt->message_queue, &message, 0, osWaitForever) == osOK;
}

int32_t bt_srv() {
    Bt* bt = bt_alloc();
    furi_record_create("bt", bt);
    furi_hal_bt_init();

    if(!furi_hal_bt_wait_startup()) {
        FURI_LOG_E(BT_SERVICE_TAG, "Core2 startup failed");
    } else {
        view_port_enabled_set(bt->statusbar_view_port, true);
        if(bt->bt_settings.enabled) {
            bool bt_app_started = furi_hal_bt_start_app();
            if(!bt_app_started) {
                FURI_LOG_E(BT_SERVICE_TAG, "BT App start failed");
            } else {
                FURI_LOG_I(BT_SERVICE_TAG, "BT App started");
            }
        }
    }

    BtMessage message;
    while(1) {
        furi_check(osMessageQueueGet(bt->message_queue, &message, NULL, osWaitForever) == osOK);
        if(message.type == BtMessageTypeUpdateStatusbar) {
            // Update statusbar
            view_port_enabled_set(bt->statusbar_view_port, furi_hal_bt_is_alive());
        } else if(message.type == BtMessageTypeUpdateBatteryLevel) {
            if(furi_hal_bt_is_alive()) {
                battery_svc_update_level(message.data.battery_level);
            }
        }
    }
    return 0;
}