#include #if CONFIG_HAL_BOARD == HAL_BOARD_LINUX #include #include #include #include #include #include #include extern const AP_HAL::HAL& hal; #include "Util.h" using namespace Linux; static int state; ToneAlarm LinuxUtil::_toneAlarm; /** return commandline arguments, if available */ void LinuxUtil::commandline_arguments(uint8_t &argc, char * const *&argv) { argc = saved_argc; argv = saved_argv; } bool LinuxUtil::toneAlarm_init() { return _toneAlarm.init(); } void LinuxUtil::toneAlarm_set_tune(uint8_t tone) { _toneAlarm.set_tune(tone); } void LinuxUtil::_toneAlarm_timer_tick(){ if(state == 0){ state = state + _toneAlarm.init_tune(); }else if(state == 1){ state = state + _toneAlarm.set_note(); } if(state == 2){ state = state + _toneAlarm.play(); }else if(state == 3){ state = 1; } if(_toneAlarm.is_tune_comp()){ state = 0; } } void LinuxUtil::set_system_clock(uint64_t time_utc_usec) { #if CONFIG_HAL_BOARD_SUBTYPE != HAL_BOARD_SUBTYPE_LINUX_NONE timespec ts; ts.tv_sec = time_utc_usec/1.0e6; ts.tv_nsec = (time_utc_usec % 1000000) * 1000; clock_settime(CLOCK_REALTIME, &ts); #endif } bool LinuxUtil::is_chardev_node(const char *path) { struct stat st; if (!path || lstat(path, &st) < 0) return false; return S_ISCHR(st.st_mode); } #endif // CONFIG_HAL_BOARD == HAL_BOARD_LINUX