diff --git a/libraries/AP_HAL_Linux/AnalogIn_Navio2.cpp b/libraries/AP_HAL_Linux/AnalogIn_Navio2.cpp index 2bf414ed89..789e852c06 100644 --- a/libraries/AP_HAL_Linux/AnalogIn_Navio2.cpp +++ b/libraries/AP_HAL_Linux/AnalogIn_Navio2.cpp @@ -99,6 +99,7 @@ float AnalogIn_Navio2::board_voltage(void) { return _board_voltage_pin->voltage_average(); } + float AnalogIn_Navio2::servorail_voltage(void) { return _servorail_pin->voltage_average(); diff --git a/libraries/AP_HAL_Linux/Util.cpp b/libraries/AP_HAL_Linux/Util.cpp index e60d5555b2..793c118a5c 100644 --- a/libraries/AP_HAL_Linux/Util.cpp +++ b/libraries/AP_HAL_Linux/Util.cpp @@ -67,19 +67,19 @@ void Util::toneAlarm_set_tune(uint8_t tone) _toneAlarm.set_tune(tone); } -void Util::_toneAlarm_timer_tick(){ - if(state == 0){ +void Util::_toneAlarm_timer_tick() { + if(state == 0) { state = state + _toneAlarm.init_tune(); - }else if(state == 1){ + } else if (state == 1) { state = state + _toneAlarm.set_note(); } - if(state == 2){ + if (state == 2) { state = state + _toneAlarm.play(); - }else if(state == 3){ + } else if (state == 3) { state = 1; } - if(_toneAlarm.is_tune_comp()){ + if (_toneAlarm.is_tune_comp()) { state = 0; } @@ -99,8 +99,9 @@ bool Util::is_chardev_node(const char *path) { struct stat st; - if (!path || lstat(path, &st) < 0) + if (!path || lstat(path, &st) < 0) { return false; + } return S_ISCHR(st.st_mode); } @@ -120,7 +121,7 @@ int Util::write_file(const char *path, const char *fmt, ...) { errno = 0; - int fd = ::open(path, O_WRONLY | O_CLOEXEC); + int fd = open(path, O_WRONLY | O_CLOEXEC); if (fd == -1) { return -errno; } @@ -128,9 +129,9 @@ int Util::write_file(const char *path, const char *fmt, ...) va_list args; va_start(args, fmt); - int ret = ::vdprintf(fd, fmt, args); + int ret = vdprintf(fd, fmt, args); int errno_bkp = errno; - ::close(fd); + close(fd); va_end(args); @@ -145,21 +146,23 @@ int Util::read_file(const char *path, const char *fmt, ...) { errno = 0; - FILE *file = ::fopen(path, "re"); - if (!file) + FILE *file = fopen(path, "re"); + if (!file) { return -errno; + } va_list args; va_start(args, fmt); - int ret = ::vfscanf(file, fmt, args); + int ret = vfscanf(file, fmt, args); int errno_bkp = errno; - ::fclose(file); + fclose(file); va_end(args); - if (ret < 1) + if (ret < 1) { return -errno_bkp; + } return ret; } @@ -174,33 +177,25 @@ const char *Linux::Util::_hw_names[UTIL_NUM_HARDWARES] = { #define MAX_SIZE_LINE 50 int Util::get_hw_arm32() { - int ret = -ENOENT; - char buffer[MAX_SIZE_LINE]; - const char* hardware_description_entry = "Hardware"; - char* flag; - FILE* f; - - f = fopen("/proc/cpuinfo", "r"); - + char buffer[MAX_SIZE_LINE] = { 0 }; + FILE *f = fopen("/proc/cpuinfo", "r"); if (f == NULL) { - ret = -errno; - goto end; + return -errno; } while (fgets(buffer, MAX_SIZE_LINE, f) != NULL) { - flag = strstr(buffer, hardware_description_entry); - if (flag != NULL) { - for (uint8_t i = 0; i < UTIL_NUM_HARDWARES; i++) { - if (strstr(buffer, _hw_names[i]) != 0) { - ret = i; - goto close_end; - } + if (strstr(buffer, "Hardware") == NULL) { + continue; + } + for (uint8_t i = 0; i < UTIL_NUM_HARDWARES; i++) { + if (strstr(buffer, _hw_names[i]) == NULL) { + continue; } + fclose(f); + return i; } } -close_end: fclose(f); -end: - return ret; + return -ENOENT; }