Commit 872ba81d authored by roangel's avatar roangel
Browse files

debug message

parent 9f24e1be
......@@ -473,7 +473,7 @@ void viconCallback(const ViconData& viconData) {
else //SAFE_CONTROLLER and state is different from flying
calculateDistanceToCurrentSafeSetpoint(local); // update distance, it also updates the unit vector
ROS_INFO_STREAM("distance: " << distance);
// ROS_INFO_STREAM("distance: " << distance);
// here, detect if euclidean distance between setpoint and current position is higher than a threshold
if(distance > distance_threshold)
Supports Markdown
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment