//add Alex
bool MagnitoCalibCallback(std_srvs::Empty::Request &request, std_srvs::Empty::Response &response)
{
    vp_os_mutex_lock(&twist_lock);
    ardrone_at_set_calibration(0);
    vp_os_mutex_unlock(&twist_lock);
    fprintf(stderr, "\nMagnito calibration.\n");
}
Beispiel #2
0
void ARDroneRos::magCalibCallback(const std_msgs::Empty &msg)
{
  boost::lock_guard<boost::mutex> guard (control_mutex_);
  if(current_control_msg_.airborne == true)
  {
      ardrone_at_set_calibration(0); //0 is for magnetometer.
  }
}
C_RESULT calibrate_magneto(void *arg) {
    ardrone_at_set_calibration(ARDRONE_CALIBRATION_DEVICE_MAGNETOMETER);
    return C_OK;
}