//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"); }
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; }