Browse Source

commander: add support for Aerotenna OcPoC-Zynq hardware

sbg
davidaroyer 8 years ago committed by Lorenz Meier
parent
commit
dbbe3c0863
  1. 3
      src/modules/commander/PreflightCheck.cpp
  2. 26
      src/modules/commander/esc_calibration.cpp

3
src/modules/commander/PreflightCheck.cpp

@ -571,6 +571,9 @@ bool preflightCheck(orb_advert_t *mavlink_log_pub, bool checkMag, bool checkAcc, @@ -571,6 +571,9 @@ bool preflightCheck(orb_advert_t *mavlink_log_pub, bool checkMag, bool checkAcc,
#elif defined(__PX4_POSIX_BEBOP)
PX4_WARN("Preflight checks always pass on Bebop.");
return true;
#elif defined(__PX4_POSIX_OCPOC)
PX4_WARN("Preflight checks always pass on OcPoC.");
return true;
#endif
bool failed = false;

26
src/modules/commander/esc_calibration.cpp

@ -78,6 +78,31 @@ int do_esc_calibration(orb_advert_t *mavlink_log_pub, struct actuator_armed_s* a @@ -78,6 +78,31 @@ int do_esc_calibration(orb_advert_t *mavlink_log_pub, struct actuator_armed_s* a
{
int return_code = PX4_OK;
#if defined(__PX4_POSIX_OCPOC)
hrt_abstime timeout_start;
hrt_abstime timeout_wait = 60*1000*1000;
armed->in_esc_calibration_mode = true;
calibration_log_info(mavlink_log_pub, CAL_QGC_DONE_MSG, "begin esc");
timeout_start = hrt_absolute_time();
while (true) {
if (hrt_absolute_time() - timeout_start > timeout_wait) {
break;
}else{
usleep(50000);
}
}
armed->in_esc_calibration_mode = false;
calibration_log_info(mavlink_log_pub, CAL_QGC_DONE_MSG, "end esc");
if (return_code == OK) {
calibration_log_info(mavlink_log_pub, CAL_QGC_DONE_MSG, "esc");
}
return return_code;
#else
int fd = -1;
struct battery_status_s battery;
@ -192,4 +217,5 @@ Out: @@ -192,4 +217,5 @@ Out:
Error:
return_code = PX4_ERROR;
goto Out;
#endif
}

Loading…
Cancel
Save