250 lines
		
	
	
		
			8.4 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			250 lines
		
	
	
		
			8.4 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);
 | |
|     } else if(result == DialogResultBack) {
 | |
|         view_dispatcher_switch_to_view(power->view_dispatcher, VIEW_NONE);
 | |
|     }
 | |
| }
 | |
| 
 | |
| 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, "Reboot 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("Reboot", 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->charge == 0 && 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;
 | |
| }
 | 
