ardupilot/libraries/AP_HAL_SITL/Util.h

105 lines
2.7 KiB
C++

#pragma once
#include <AP_HAL/AP_HAL.h>
#include "AP_HAL_SITL_Namespace.h"
#include "AP_HAL_SITL.h"
#include "Semaphores.h"
#include "ToneAlarm_SF.h"
#if !defined(__CYGWIN__) && !defined(__CYGWIN64__)
#include <sys/types.h>
#include <signal.h>
#endif
class HALSITL::Util : public AP_HAL::Util {
public:
Util(SITL_State *_sitlState) :
sitlState(_sitlState) {}
bool run_debug_shell(AP_HAL::BetterStream *stream) override {
return false;
}
/**
how much free memory do we have in bytes.
*/
uint32_t available_memory(void) override {
// SITL is assumed to always have plenty of memory. Return 128k for now
return 0x20000;
}
// get path to custom defaults file for AP_Param
const char* get_custom_defaults_file() const override {
return sitlState->defaults_path;
}
/**
return commandline arguments, if available
*/
void commandline_arguments(uint8_t &argc, char * const *&argv) override;
uint64_t get_hw_rtc() const override;
bool get_system_id(char buf[40]) override;
bool get_system_id_unformatted(uint8_t buf[], uint8_t &len) override;
void dump_stack_trace();
#ifdef ENABLE_HEAP
// heap functions, note that a heap once alloc'd cannot be dealloc'd
void *allocate_heap_memory(size_t size) override;
void *heap_realloc(void *heap, void *ptr, size_t new_size) override;
#endif // ENABLE_HEAP
#ifdef WITH_SITL_TONEALARM
bool toneAlarm_init(uint8_t types) override { return _toneAlarm.init(); }
void toneAlarm_set_buzzer_tone(float frequency, float volume, uint32_t duration_ms) override {
_toneAlarm.set_buzzer_tone(frequency, volume, duration_ms);
}
#endif
// return true if the reason for the reboot was a watchdog reset
bool was_watchdog_reset() const override { return getenv("SITL_WATCHDOG_RESET") != nullptr; }
#if !defined(HAL_BUILD_AP_PERIPH)
enum safety_state safety_switch_state(void) override;
void set_cmdline_parameters() override;
#endif
bool trap() const override {
#if defined(__CYGWIN__) || defined(__CYGWIN64__)
return false;
#else
if (kill(0, SIGTRAP) == -1) {
return false;
}
return true;
#endif
}
void init(int argc, char *const *argv) {
saved_argc = argc;
saved_argv = argv;
}
private:
SITL_State *sitlState;
#ifdef WITH_SITL_TONEALARM
static ToneAlarm_SF _toneAlarm;
#endif
#ifdef ENABLE_HEAP
struct heap_allocation_header {
size_t allocation_size; // size of allocated block, not including this header
};
struct heap {
size_t scripting_max_heap_size;
size_t current_heap_usage;
};
#endif // ENABLE_HEAP
int saved_argc;
char *const *saved_argv;
};