SITL: Add missing shove forces in SIM_Submarine

Signed-off-by: Patrick José Pereira <patrickelectric@gmail.com>
This commit is contained in:
Patrick José Pereira 2019-10-28 12:17:08 -07:00 committed by Peter Barker
parent 7a20410752
commit e18883fddf

View File

@ -81,6 +81,8 @@ void Submarine::calculate_forces(const struct sitl_input &input, Vector3f &rot_a
calculate_drag_force(gyro, frame_property.angular_drag_coefficient, angular_drag_forces);
// Add forces in body frame accel
rot_accel -= angular_drag_forces / frame_property.weight;
add_shove_forces(rot_accel, body_accel);
}
/**