uint8_t percent = flash_status.percent_used;
if(percent < 30) return 2; // High rate if(percent < 60) return 1; // Normal rate if(percent < 85) return 0; // Low rate return 0; // Minimal rate when almost full }
if(strcmp(arg, "adaptive_bb") == 0) { char *subcmd = strtok(NULL, " "); if(subcmd == NULL) { // Show status cliPrintLinef("Adaptive Blackbox Status:"); cliPrintLinef("Flash total: %u bytes", flash_status.total_bytes); cliPrintLinef("Free: %u bytes (%u%%)", flash_status.free_bytes, 100 - flash_status.percent_used); cliPrintLinef("Est. recording: %d seconds", flash_status.estimated_log_seconds); cliPrintLinef("Resolution: %s", adaptive_bb_config.resolution == 0 ? "Low" : adaptive_bb_config.resolution == 1 ? "Normal" : "High"); cliPrintLinef("Auto erase: %s", adaptive_bb_config.auto_erase ? "ON" : "OFF"); cliPrintLinef("Dynamic rate: %s", adaptive_bb_config.dynamic_rate ? "ON" : "OFF"); } else if(strcmp(subcmd, "resolution") == 0) { uint8_t val = atoi(strtok(NULL, " ")); if(val <= 2) { adaptive_bb_config.resolution = val; cliPrintLinef("Resolution set to %d", val); } } else if(strcmp(subcmd, "auto_erase") == 0) { adaptive_bb_config.auto_erase = atoi(strtok(NULL, " ")); cliPrintLinef("Auto erase set to %d", adaptive_bb_config.auto_erase); } else if(strcmp(subcmd, "max_time") == 0) { adaptive_bb_config.max_log_seconds = atoi(strtok(NULL, " ")); cliPrintLinef("Max log time set to %d seconds", adaptive_bb_config.max_log_seconds); } else if(strcmp(subcmd, "dynamic") == 0) { adaptive_bb_config.dynamic_rate = atoi(strtok(NULL, " ")); cliPrintLinef("Dynamic rate set to %d", adaptive_bb_config.dynamic_rate); } } }
// Flash monitoring typedef struct flash_status_s { uint32_t total_bytes; uint32_t free_bytes; uint32_t used_bytes; uint8_t percent_used; uint16_t estimated_log_seconds; } flash_status_t; 2m flash - use fmuv3 firmware
// CLI command handler void adaptive_blackbox_cli(char *cmdline) { char *arg = strtok(cmdline, " ");
// Rate calculation: 1kHz = ~2KB/sec (gyro+accel+debug) switch(adaptive_bb_config.resolution) { case 0: // Low (500Hz gyro, no accel) bytes_per_second = 800; break; case 1: // Normal (1kHz gyro, 1kHz accel) bytes_per_second = 2000; break; case 2: // High (2kHz gyro, 1kHz accel, debug) bytes_per_second = 4000; break; default: bytes_per_second = 2000; }
// Main feature: auto-configure blackbox on boot void adaptive_blackbox_init(void) { // Get flash geometry flash_status.total_bytes = flash_getSize(); flash_status.free_bytes = flash_getFreeSpace(); flash_status.used_bytes = flash_status.total_bytes - flash_status.free_bytes; flash_status.percent_used = (flash_status.used_bytes * 100) / flash_status.total_bytes; uint8_t percent = flash_status
// Check if flash is 2MB (typical FMUV3 boards) if(flash_status.total_bytes == 2 * 1024 * 1024) { // Configure for 2M flash blackboxConfig()->rate_num = 1; blackboxConfig()->rate_denom = 1; // Auto-admit settings if(flash_status.percent_used > 90) { smart_erase_oldest(); } // Set max log size uint16_t max_seconds = adaptive_bb_config.max_log_seconds; if(max_seconds > 0) { uint32_t max_bytes = max_seconds * 2000; // 2KB/sec estimate if(max_bytes < flash_status.free_bytes) { blackboxConfig()->max_log_size_kb = max_bytes / 1024; } } // Apply dynamic rate uint8_t dyn_rate = calculate_dynamic_rate(); if(dyn_rate == 0) { blackboxConfig()->rate_num = 1; blackboxConfig()->rate_denom = 2; // 500Hz } else if(dyn_rate == 1) { blackboxConfig()->rate_num = 1; blackboxConfig()->rate_denom = 1; // 1kHz } else { blackboxConfig()->rate_num = 2; blackboxConfig()->rate_denom = 1; // 2kHz } }
// Calculate remaining recording time based on current settings static uint16_t estimate_remaining_time(void) { uint32_t bytes_per_second;
// Estimate recording time flash_status.estimated_log_seconds = estimate_remaining_time(); } "Normal" : "High")
// Smart erase: remove oldest 25% of logs when full static void smart_erase_oldest(void) { if (!adaptive_bb_config.auto_erase) return;
// Find oldest log (simplified - would need blackbox log iterator) uint32_t oldest_log_address = 0; uint32_t oldest_log_size = 0;
static flash_status_t flash_status;