248 lines
		
	
	
		
			8.3 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			248 lines
		
	
	
		
			8.3 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
#include "power.h"
 | 
						|
#include "power_cli.h"
 | 
						|
#include "power_views.h"
 | 
						|
 | 
						|
#include <furi.h>
 | 
						|
#include <api-hal.h>
 | 
						|
 | 
						|
#include <menu/menu.h>
 | 
						|
#include <menu/menu_item.h>
 | 
						|
 | 
						|
#include <gui/gui.h>
 | 
						|
#include <gui/view_port.h>
 | 
						|
#include <gui/view.h>
 | 
						|
#include <gui/view_dispatcher.h>
 | 
						|
#include <gui/modules/dialog.h>
 | 
						|
#include <assets_icons.h>
 | 
						|
#include <stm32wbxx.h>
 | 
						|
 | 
						|
#define POWER_OFF_TIMEOUT 30
 | 
						|
 | 
						|
struct Power {
 | 
						|
    ViewDispatcher* view_dispatcher;
 | 
						|
    View* info_view;
 | 
						|
    View* off_view;
 | 
						|
    View* disconnect_view;
 | 
						|
 | 
						|
    Icon* battery_icon;
 | 
						|
    ViewPort* battery_view_port;
 | 
						|
 | 
						|
    Dialog* dialog;
 | 
						|
 | 
						|
    ValueMutex* menu_vm;
 | 
						|
    Cli* cli;
 | 
						|
    MenuItem* menu;
 | 
						|
};
 | 
						|
 | 
						|
void power_draw_battery_callback(Canvas* canvas, void* context) {
 | 
						|
    furi_assert(context);
 | 
						|
    Power* power = context;
 | 
						|
    canvas_draw_icon(canvas, 0, 0, power->battery_icon);
 | 
						|
    with_view_model(
 | 
						|
        power->info_view, (PowerInfoModel * model) {
 | 
						|
            canvas_draw_box(canvas, 2, 2, (float)model->charge / 100 * 20, 4);
 | 
						|
            return false;
 | 
						|
        });
 | 
						|
}
 | 
						|
 | 
						|
uint32_t power_info_back_callback(void* context) {
 | 
						|
    return VIEW_NONE;
 | 
						|
}
 | 
						|
 | 
						|
void power_menu_off_callback(void* context) {
 | 
						|
    Power* power = context;
 | 
						|
    power_off(power);
 | 
						|
}
 | 
						|
 | 
						|
void power_menu_reset_dialog_result(DialogResult result, void* context) {
 | 
						|
    Power* power = context;
 | 
						|
    if(result == DialogResultLeft) {
 | 
						|
        power_reset(power, PowerBootModeDfu);
 | 
						|
    } else if(result == DialogResultRight) {
 | 
						|
        power_reset(power, PowerBootModeNormal);
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
void power_menu_reset_callback(void* context) {
 | 
						|
    Power* power = context;
 | 
						|
    dialog_set_result_callback(power->dialog, power_menu_reset_dialog_result);
 | 
						|
    dialog_set_header_text(power->dialog, "Reset type");
 | 
						|
    dialog_set_text(power->dialog, "Reboot where?");
 | 
						|
    dialog_set_left_button_text(power->dialog, "DFU");
 | 
						|
    dialog_set_right_button_text(power->dialog, "OS");
 | 
						|
    view_dispatcher_switch_to_view(power->view_dispatcher, PowerViewDialog);
 | 
						|
}
 | 
						|
 | 
						|
void power_menu_enable_otg_callback(void* context) {
 | 
						|
    api_hal_power_enable_otg();
 | 
						|
}
 | 
						|
 | 
						|
void power_menu_disable_otg_callback(void* context) {
 | 
						|
    api_hal_power_disable_otg();
 | 
						|
}
 | 
						|
 | 
						|
void power_menu_info_callback(void* context) {
 | 
						|
    Power* power = context;
 | 
						|
    view_dispatcher_switch_to_view(power->view_dispatcher, PowerViewInfo);
 | 
						|
}
 | 
						|
 | 
						|
Power* power_alloc() {
 | 
						|
    Power* power = furi_alloc(sizeof(Power));
 | 
						|
 | 
						|
    power->menu_vm = furi_record_open("menu");
 | 
						|
 | 
						|
    power->cli = furi_record_open("cli");
 | 
						|
    power_cli_init(power->cli, power);
 | 
						|
 | 
						|
    power->menu = menu_item_alloc_menu("Power", assets_icons_get(A_Power_14));
 | 
						|
    menu_item_subitem_add(
 | 
						|
        power->menu, menu_item_alloc_function("Off", NULL, power_menu_off_callback, power));
 | 
						|
    menu_item_subitem_add(
 | 
						|
        power->menu, menu_item_alloc_function("Reset", NULL, power_menu_reset_callback, power));
 | 
						|
    menu_item_subitem_add(
 | 
						|
        power->menu,
 | 
						|
        menu_item_alloc_function("Enable OTG", NULL, power_menu_enable_otg_callback, power));
 | 
						|
    menu_item_subitem_add(
 | 
						|
        power->menu,
 | 
						|
        menu_item_alloc_function("Disable OTG", NULL, power_menu_disable_otg_callback, power));
 | 
						|
    menu_item_subitem_add(
 | 
						|
        power->menu, menu_item_alloc_function("Info", NULL, power_menu_info_callback, power));
 | 
						|
 | 
						|
    power->view_dispatcher = view_dispatcher_alloc();
 | 
						|
    power->info_view = view_alloc();
 | 
						|
    view_allocate_model(power->info_view, ViewModelTypeLockFree, sizeof(PowerInfoModel));
 | 
						|
    view_set_draw_callback(power->info_view, power_info_draw_callback);
 | 
						|
    view_set_previous_callback(power->info_view, power_info_back_callback);
 | 
						|
    view_dispatcher_add_view(power->view_dispatcher, PowerViewInfo, power->info_view);
 | 
						|
 | 
						|
    power->off_view = view_alloc();
 | 
						|
    view_allocate_model(power->off_view, ViewModelTypeLockFree, sizeof(PowerOffModel));
 | 
						|
    view_set_draw_callback(power->off_view, power_off_draw_callback);
 | 
						|
    view_dispatcher_add_view(power->view_dispatcher, PowerViewOff, power->off_view);
 | 
						|
 | 
						|
    power->disconnect_view = view_alloc();
 | 
						|
    view_set_draw_callback(power->disconnect_view, power_disconnect_draw_callback);
 | 
						|
    view_dispatcher_add_view(power->view_dispatcher, PowerViewDisconnect, power->disconnect_view);
 | 
						|
 | 
						|
    power->dialog = dialog_alloc();
 | 
						|
    dialog_set_context(power->dialog, power);
 | 
						|
    view_dispatcher_add_view(
 | 
						|
        power->view_dispatcher, PowerViewDialog, dialog_get_view(power->dialog));
 | 
						|
 | 
						|
    power->battery_icon = assets_icons_get(I_Battery_26x8);
 | 
						|
    power->battery_view_port = view_port_alloc();
 | 
						|
 | 
						|
    view_port_set_width(power->battery_view_port, icon_get_width(power->battery_icon));
 | 
						|
    view_port_draw_callback_set(power->battery_view_port, power_draw_battery_callback, power);
 | 
						|
    return power;
 | 
						|
}
 | 
						|
 | 
						|
void power_free(Power* power) {
 | 
						|
    furi_assert(power);
 | 
						|
    free(power);
 | 
						|
}
 | 
						|
 | 
						|
void power_off(Power* power) {
 | 
						|
    furi_assert(power);
 | 
						|
    api_hal_power_off();
 | 
						|
    view_dispatcher_switch_to_view(power->view_dispatcher, PowerViewDisconnect);
 | 
						|
}
 | 
						|
 | 
						|
void power_reset(Power* power, PowerBootMode mode) {
 | 
						|
    if(mode == PowerBootModeNormal) {
 | 
						|
        api_hal_boot_set_mode(ApiHalBootModeNormal);
 | 
						|
    } else if(mode == PowerBootModeDfu) {
 | 
						|
        api_hal_boot_set_mode(ApiHalBootModeDFU);
 | 
						|
    }
 | 
						|
    api_hal_power_reset();
 | 
						|
}
 | 
						|
 | 
						|
static void power_charging_indication_handler() {
 | 
						|
    if(api_hal_power_is_charging()) {
 | 
						|
        if(api_hal_power_get_pct() == 100) {
 | 
						|
            api_hal_light_set(LightRed, 0x00);
 | 
						|
            api_hal_light_set(LightGreen, 0xFF);
 | 
						|
        } else {
 | 
						|
            api_hal_light_set(LightGreen, 0x00);
 | 
						|
            api_hal_light_set(LightRed, 0xFF);
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    if(!api_hal_power_is_charging()) {
 | 
						|
        api_hal_light_set(LightRed, 0x00);
 | 
						|
        api_hal_light_set(LightGreen, 0x00);
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
int32_t power_task(void* p) {
 | 
						|
    (void)p;
 | 
						|
    Power* power = power_alloc();
 | 
						|
 | 
						|
    Gui* gui = furi_record_open("gui");
 | 
						|
    gui_add_view_port(gui, power->battery_view_port, GuiLayerStatusBarRight);
 | 
						|
    view_dispatcher_attach_to_gui(power->view_dispatcher, gui, ViewDispatcherTypeFullscreen);
 | 
						|
 | 
						|
    with_value_mutex(
 | 
						|
        power->menu_vm, (Menu * menu) { menu_item_add(menu, power->menu); });
 | 
						|
 | 
						|
    furi_record_create("power", power);
 | 
						|
 | 
						|
    while(1) {
 | 
						|
        bool battery_low = false;
 | 
						|
 | 
						|
        with_view_model(
 | 
						|
            power->info_view, (PowerInfoModel * model) {
 | 
						|
                model->charge = api_hal_power_get_pct();
 | 
						|
                model->health = api_hal_power_get_bat_health_pct();
 | 
						|
                model->capacity_remaining = api_hal_power_get_battery_remaining_capacity();
 | 
						|
                model->capacity_full = api_hal_power_get_battery_full_capacity();
 | 
						|
                model->current_charger = api_hal_power_get_battery_current(ApiHalPowerICCharger);
 | 
						|
                model->current_gauge = api_hal_power_get_battery_current(ApiHalPowerICFuelGauge);
 | 
						|
                model->voltage_charger = api_hal_power_get_battery_voltage(ApiHalPowerICCharger);
 | 
						|
                model->voltage_gauge = api_hal_power_get_battery_voltage(ApiHalPowerICFuelGauge);
 | 
						|
                model->voltage_vbus = api_hal_power_get_usb_voltage();
 | 
						|
                model->temperature_charger =
 | 
						|
                    api_hal_power_get_battery_temperature(ApiHalPowerICCharger);
 | 
						|
                model->temperature_gauge =
 | 
						|
                    api_hal_power_get_battery_temperature(ApiHalPowerICFuelGauge);
 | 
						|
 | 
						|
                if(model->voltage_gauge < 3.3f && model->voltage_vbus < 4.0f) {
 | 
						|
                    battery_low = true;
 | 
						|
                }
 | 
						|
 | 
						|
                return true;
 | 
						|
            });
 | 
						|
 | 
						|
        with_view_model(
 | 
						|
            power->off_view, (PowerOffModel * model) {
 | 
						|
                if(battery_low) {
 | 
						|
                    if(model->poweroff_tick == 0) {
 | 
						|
                        model->poweroff_tick =
 | 
						|
                            osKernelGetTickCount() + osKernelGetTickFreq() * POWER_OFF_TIMEOUT;
 | 
						|
                    } else {
 | 
						|
                        if(osKernelGetTickCount() > model->poweroff_tick) {
 | 
						|
                            power_off(power);
 | 
						|
                        }
 | 
						|
                    }
 | 
						|
                } else {
 | 
						|
                    model->poweroff_tick = 0;
 | 
						|
                }
 | 
						|
 | 
						|
                if(model->battery_low != battery_low) {
 | 
						|
                    model->battery_low = battery_low;
 | 
						|
                    view_dispatcher_switch_to_view(
 | 
						|
                        power->view_dispatcher, battery_low ? PowerViewOff : VIEW_NONE);
 | 
						|
                }
 | 
						|
                return true;
 | 
						|
            });
 | 
						|
 | 
						|
        power_charging_indication_handler();
 | 
						|
 | 
						|
        view_port_update(power->battery_view_port);
 | 
						|
 | 
						|
        osDelay(1024);
 | 
						|
    }
 | 
						|
 | 
						|
    return 0;
 | 
						|
}
 |