mirror of
https://github.com/Next-Flip/Momentum-Firmware.git
synced 2026-05-20 04:54:45 -07:00
Add Battery Reporting to FindMy
This commit is contained in:
@@ -1,5 +1,6 @@
|
||||
#include "findmy_state.h"
|
||||
|
||||
#include "findmy_i.h"
|
||||
#include <string.h>
|
||||
#include <stddef.h>
|
||||
#include <furi_hal_bt.h>
|
||||
@@ -42,6 +43,13 @@ bool findmy_state_load(FindMyState* out_state) {
|
||||
}
|
||||
state.tag_type = tmp;
|
||||
|
||||
if(!flipper_format_read_uint32(file, "battery_level", &tmp, 1)) {
|
||||
tmp = 0x00; // Default battery level set to Full
|
||||
flipper_format_rewind(file);
|
||||
}
|
||||
FURI_LOG_I("findmy_load", "Saved Battery: %ld", tmp);
|
||||
state.battery_level = tmp;
|
||||
|
||||
if(!flipper_format_read_hex(file, "mac", state.mac, sizeof(state.mac))) break;
|
||||
|
||||
if(!flipper_format_read_hex(
|
||||
@@ -74,12 +82,12 @@ bool findmy_state_load(FindMyState* out_state) {
|
||||
*data++ = 0x00; // ...
|
||||
*data++ = 0x12; // Type (FindMy)
|
||||
*data++ = 0x19; // Length
|
||||
*data++ = 0x00; // Status
|
||||
*data++ = 0x00; // Battery Status set to Full
|
||||
// Placeholder Empty Public Key without the MAC address
|
||||
for(size_t i = 0; i < 22; ++i) {
|
||||
*data++ = 0x00;
|
||||
}
|
||||
*data++ = 0x00; // First 2 bits are the version, the rest is the battery level
|
||||
*data++ = 0x00; // First 2 bits are the version
|
||||
*data++ = 0x00; // Hint (0x00)
|
||||
}
|
||||
|
||||
@@ -102,12 +110,11 @@ void findmy_state_apply(FindMyState* state) {
|
||||
if(furi_hal_bt_extra_beacon_is_active()) {
|
||||
furi_check(furi_hal_bt_extra_beacon_stop());
|
||||
}
|
||||
|
||||
furi_check(furi_hal_bt_extra_beacon_set_config(&state->config));
|
||||
|
||||
findmy_update_payload_battery(state->data, state->battery_level, state->tag_type);
|
||||
|
||||
furi_check(
|
||||
furi_hal_bt_extra_beacon_set_data(state->data, findmy_state_data_size(state->tag_type)));
|
||||
|
||||
if(state->beacon_active) {
|
||||
furi_check(furi_hal_bt_extra_beacon_start());
|
||||
}
|
||||
@@ -118,6 +125,32 @@ void findmy_state_sync_config(FindMyState* state) {
|
||||
state->config.max_adv_interval_ms = (state->broadcast_interval * 1000) + 150;
|
||||
state->config.adv_power_level = GapAdvPowerLevel_0dBm + state->transmit_power;
|
||||
memcpy(state->config.address, state->mac, sizeof(state->config.address));
|
||||
findmy_update_payload_battery(state->data, state->battery_level, state->tag_type);
|
||||
}
|
||||
|
||||
void findmy_update_payload_battery(uint8_t* data, uint8_t battery_level, FindMyType type) {
|
||||
// Update the battery level in the payload
|
||||
FURI_LOG_I("update_bat", "Before update: %d", battery_level);
|
||||
if(type == FindMyTypeApple) {
|
||||
switch(battery_level) {
|
||||
case BATTERY_FULL:
|
||||
data[6] = BATTERY_FULL;
|
||||
break;
|
||||
case BATTERY_MEDIUM:
|
||||
data[6] = BATTERY_MEDIUM;
|
||||
break;
|
||||
case BATTERY_LOW:
|
||||
data[6] = BATTERY_LOW;
|
||||
break;
|
||||
case BATTERY_CRITICAL:
|
||||
data[6] = BATTERY_CRITICAL;
|
||||
break;
|
||||
default:
|
||||
FURI_LOG_E("update_bat", "Invalid battery level: %d", battery_level);
|
||||
return;
|
||||
}
|
||||
}
|
||||
FURI_LOG_I("update_bat", "After update: %02X", data[6]);
|
||||
}
|
||||
|
||||
void findmy_state_save(FindMyState* state) {
|
||||
@@ -141,10 +174,13 @@ void findmy_state_save(FindMyState* state) {
|
||||
tmp = state->tag_type;
|
||||
if(!flipper_format_write_uint32(file, "tag_type", &tmp, 1)) break;
|
||||
|
||||
tmp = state->battery_level;
|
||||
if(!flipper_format_write_uint32(file, "battery_level", &tmp, 1)) break;
|
||||
|
||||
if(!flipper_format_write_bool(file, "show_mac", &state->show_mac, 1)) break;
|
||||
|
||||
if(!flipper_format_write_hex(file, "mac", state->mac, sizeof(state->mac))) break;
|
||||
|
||||
findmy_update_payload_battery(state->data, state->battery_level, state->tag_type);
|
||||
if(!flipper_format_write_hex(
|
||||
file, "data", state->data, findmy_state_data_size(state->tag_type)))
|
||||
break;
|
||||
|
||||
Reference in New Issue
Block a user