|
|
|
@ -240,7 +240,7 @@ void FollowTarget::on_active()
@@ -240,7 +240,7 @@ void FollowTarget::on_active()
|
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
// warnx(" _step_vel x %3.6f y %3.6f cur vel %3.6f %3.6f tar vel %3.6f %3.6f dist = %3.6f (%3.6f) mode = %d con ratio = %3.6f yaw rate = %3.6f",
|
|
|
|
|
// warnx(" _step_vel x %3.6f y %3.6f cur vel %3.6f %3.6f tar vel %3.6f %3.6f dist = %3.6f (%3.6f) mode = %d yaw rate = %3.6f",
|
|
|
|
|
// (double) _step_vel(0),
|
|
|
|
|
// (double) _step_vel(1),
|
|
|
|
|
// (double) _current_vel(0),
|
|
|
|
@ -250,7 +250,7 @@ void FollowTarget::on_active()
@@ -250,7 +250,7 @@ void FollowTarget::on_active()
|
|
|
|
|
// (double) (_target_distance).length(),
|
|
|
|
|
// (double) (_target_position_offset + _target_distance).length(),
|
|
|
|
|
// _follow_target_state,
|
|
|
|
|
// (double)_avg_cos_ratio, (double) _yaw_rate);
|
|
|
|
|
// (double) _yaw_rate);
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (target_position_valid()) { |
|
|
|
|