#pragma once #include #include "AP_HAL_Namespace.h" class AP_HAL::Util { public: int snprintf(char* str, size_t size, const char *format, ...); int vsnprintf(char* str, size_t size, const char *format, va_list ap); void set_soft_armed(const bool b); bool get_soft_armed() const { return soft_armed; } // return the time that the armed state last changed uint32_t get_last_armed_change() const { return last_armed_change_ms; }; // return true if the reason for the reboot was a watchdog reset virtual bool was_watchdog_reset() const { return false; } // return true if safety was off and this was a watchdog reset bool was_watchdog_safety_off() const { return was_watchdog_reset() && persistent_data.safety_state == SAFETY_ARMED; } // return true if this is a watchdog reset boot and we were armed bool was_watchdog_armed() const { return was_watchdog_reset() && persistent_data.armed; } virtual const char* get_custom_log_directory() const { return nullptr; } virtual const char* get_custom_terrain_directory() const { return nullptr; } virtual const char *get_custom_storage_directory() const { return nullptr; } // get path to custom defaults file for AP_Param virtual const char* get_custom_defaults_file() const { return HAL_PARAM_DEFAULTS_PATH; } // run a debug shall on the given stream if possible. This is used // to support dropping into a debug shell to run firmware upgrade // commands virtual bool run_debug_shell(AP_HAL::BetterStream *stream) = 0; enum safety_state : uint8_t { SAFETY_NONE, SAFETY_DISARMED, SAFETY_ARMED }; /* persistent data structure. This data is restored on boot if there has been a watchdog reset. The data in this structure should only be read if was_watchdog_reset() is true Note that on STM32 this structure is limited to 76 bytes */ struct PersistentData { float roll_rad, pitch_rad, yaw_rad; // attitude int32_t home_lat, home_lon, home_alt_cm; // home position uint32_t fault_addr; uint32_t fault_icsr; uint32_t fault_lr; uint32_t internal_errors; uint16_t internal_error_count; uint16_t internal_error_last_line; uint32_t spi_count; uint32_t i2c_count; uint32_t i2c_isr_count; uint16_t waypoint_num; uint16_t last_mavlink_msgid; uint16_t last_mavlink_cmd; uint16_t semaphore_line; uint16_t fault_line; uint8_t fault_type; uint8_t fault_thd_prio; char thread_name4[4]; int8_t scheduler_task; bool armed; // true if vehicle was armed enum safety_state safety_state; }; struct PersistentData persistent_data; // last_persistent_data is only filled in if we've suffered a watchdog reset struct PersistentData last_persistent_data; /* return state of safety switch, if applicable */ virtual enum safety_state safety_switch_state(void) { return SAFETY_NONE; } /* set HW RTC in UTC microseconds */ virtual void set_hw_rtc(uint64_t time_utc_usec); /* get system clock in UTC microseconds */ virtual uint64_t get_hw_rtc() const; enum class FlashBootloader { OK=0, NO_CHANGE=1, FAIL=2, NOT_AVAILABLE=3, }; // overwrite bootloader (probably with one from ROMFS) virtual FlashBootloader flash_bootloader() { return FlashBootloader::NOT_AVAILABLE; } /* get system identifier (eg. serial number) return false if a system identifier is not available Buf should be filled with a printable string and must be null terminated */ virtual bool get_system_id(char buf[40]) { return false; } virtual bool get_system_id_unformatted(uint8_t buf[], uint8_t &len) { return false; } /** return commandline arguments, if available */ virtual void commandline_arguments(uint8_t &argc, char * const *&argv) { argc = 0; } /* ToneAlarm Driver */ virtual bool toneAlarm_init() { return false;} virtual void toneAlarm_set_buzzer_tone(float frequency, float volume, uint32_t duration_ms) {} /* return a stream for access to a system shell, if available */ virtual AP_HAL::BetterStream *get_shell_stream() { return nullptr; } /* Support for an imu heating system */ virtual void set_imu_temp(float current) {} /* Support for an imu heating system */ virtual void set_imu_target_temp(int8_t *target) {} /* performance counter calls - wrapper around original PX4 interface */ enum perf_counter_type { PC_COUNT, /**< count the number of times an event occurs */ PC_ELAPSED, /**< measure the time elapsed performing an event */ PC_INTERVAL /**< measure the interval between instances of an event */ }; typedef void *perf_counter_t; virtual perf_counter_t perf_alloc(perf_counter_type t, const char *name) { return nullptr; } virtual void perf_begin(perf_counter_t h) {} virtual void perf_end(perf_counter_t h) {} virtual void perf_count(perf_counter_t h) {} // allocate and free DMA-capable memory if possible. Otherwise return normal memory enum Memory_Type { MEM_DMA_SAFE, MEM_FAST }; virtual void *malloc_type(size_t size, Memory_Type mem_type) { return calloc(1, size); } virtual void free_type(void *ptr, size_t size, Memory_Type mem_type) { return free(ptr); } #ifdef ENABLE_HEAP // heap functions, note that a heap once alloc'd cannot be dealloc'd virtual void *allocate_heap_memory(size_t size) = 0; virtual void *heap_realloc(void *heap, void *ptr, size_t new_size) = 0; #if USE_LIBC_REALLOC virtual void *std_realloc(void *ptr, size_t new_size) { return realloc(ptr, new_size); } #else virtual void *std_realloc(void *ptr, size_t new_size) = 0; #endif // USE_LIBC_REALLOC #endif // ENABLE_HEAP /** how much free memory do we have in bytes. If unknown return 4096 */ virtual uint32_t available_memory(void) { return 4096; } /* initialise (or re-initialise) filesystem storage */ virtual bool fs_init(void) { return false; } protected: // we start soft_armed false, so that actuators don't send any // values until the vehicle code has fully started bool soft_armed = false; uint32_t last_armed_change_ms; };