diff --git a/rotational_recovery/src/rotational_recovery.cpp b/rotational_recovery/src/rotational_recovery.cpp index d25c9e1a9780c3667435b36b53764845e9d9f5c7..a7010ad14aedacba671a3a67a710b98ad7317ea5 100644 --- a/rotational_recovery/src/rotational_recovery.cpp +++ b/rotational_recovery/src/rotational_recovery.cpp @@ -162,7 +162,7 @@ namespace rotational_recovery ROS_DEBUG_NAMED ("top", "finish Cost"); if(t < 1.0) { - ROS_INFO_NAMED ("top", "Sim time: %.2f, Current cost: %.2f, current = (%.2f, %.2f, %.2f)", t, next_cost, current_tmp.x, current_tmp.y, current_tmp.theta); + ROS_DEBUG_NAMED ("top", "Sim time: %.2f, Current cost: %.2f, current = (%.2f, %.2f, %.2f)", t, next_cost, current_tmp.x, current_tmp.y, current_tmp.theta); } //if (next_cost > cost) { @@ -174,8 +174,8 @@ namespace rotational_recovery cost = next_cost; } ROS_DEBUG_NAMED ("top", "cost = %.2f, next_cost = %.2f", cost, next_cost); - ROS_INFO_NAMED ("top", "linear.x = %.2f, linear.y = %.2f, angular.z = %.2f", twist.linear.x, twist.linear.y, twist.angular.z); - ROS_INFO_NAMED ("top", "init = (%.2f, %.2f, %.2f), current = (%.2f, %.2f, %.2f)", + ROS_DEBUG_NAMED ("top", "linear.x = %.2f, linear.y = %.2f, angular.z = %.2f", twist.linear.x, twist.linear.y, twist.angular.z); + ROS_DEBUG_NAMED ("top", "init = (%.2f, %.2f, %.2f), current = (%.2f, %.2f, %.2f)", current.x, current.y, current.theta, current_tmp.x, current_tmp.y, current_tmp.theta); ROS_DEBUG_NAMED ("top", "time = %.2f", t);