Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-03-03 12:14:10 -04:00
Code Issues Packages Projects Releases Wiki Activity

SITL: Sub: Use proper phyisics for thrusters

Browse Source
This commit is contained in:
Willian Galvani 2019-09-18 12:32:18 -03:00 committed by Jacob Walser
parent 195efaeec0
commit 16f9a29da9
1 changed files with 2 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
libraries/SITL/SIM_Submarine.cpp
View File

@ -83,9 +83,8 @@ void Submarine::calculate_forces(const struct sitl_input &input, Vector3f &rot_a
} }
// 2.5 scalar for approximate real-life performance of T200 thruster // 2.5 scalar for approximate real-life performance of T200 thruster
body_accel += t.linear * output * 2.5; body_accel += t.linear * output * frame_property.thrust / frame_property.weight;
rot_accel += t.rotational * output * frame_property.thrust * frame_property.thruster_mount_radius / frame_property.moment_of_inertia;
rot_accel += t.rotational * output;
} }
// Limit movement at the sea floor // Limit movement at the sea floor