Improved trim detection algorithm

2012-06-17 12:58:11 +02:00 · 2012-06-17 12:58:11 +02:00 · 3f7cad32f0
commit 3f7cad32f0
parent 0286a2602e
1 changed files with 2 additions and 2 deletions
--- a/src/Mod/Ship/tankGZ/TaskPanel.py
+++ b/src/Mod/Ship/tankGZ/TaskPanel.py
@ -247,9 +247,9 @@ class TaskPanel:
        # Iterate looking stability point
        dVar = math.copysign(0.01, var)
        while True:
-            if (dVar*math.copysign(dVar, var) < 0.0):
+            if (dVar*var < 0.0) or (abs(var) < 0.1):
                break
-            trim = trim - math.copysign(dVar, var)
+            trim = trim - math.copysign(max(dVar, abs(var)/200.0), var)
            # Get center of gravity
            disp  = self.computeDisplacement(trim)
            G     = [disp[1], disp[2], disp[3]]