constant acceleration breaking for collision prevention

This commit is contained in:
baumanta
2019-06-04 16:47:33 +02:00
committed by Mathieu Bresciani
parent 6f9598c76a
commit 8427cd3051
3 changed files with 47 additions and 34 deletions
@@ -134,7 +134,7 @@ void FlightTaskManualPosition::_scaleSticks()
// collision prevention
if (_collision_prevention.is_active()) {
_collision_prevention.modifySetpoint(vel_sp_xy, _velocity_scale);
_collision_prevention.modifySetpoint(vel_sp_xy, _velocity_scale, _velocity);
}
_velocity_setpoint(0) = vel_sp_xy(0);