From 8175042a455278c6a619b4e899e08371fa0538b5 Mon Sep 17 00:00:00 2001
From: Uwe Fechner <fechner@aenarete.eu>
Date: Sun, 15 Sep 2024 15:31:53 +0200
Subject: [PATCH] plot turn rate law constant G

---
 examples/steering_test.jl | 11 +++++++++--
 1 file changed, 9 insertions(+), 2 deletions(-)

diff --git a/examples/steering_test.jl b/examples/steering_test.jl
index 9b36cddd..23ead3fc 100644
--- a/examples/steering_test.jl
+++ b/examples/steering_test.jl
@@ -101,9 +101,16 @@ function plot_steering_vs_turn_rate()
     psi = rad2deg.(wrap2pi.(sl.heading))
     p1=plot(sl.time, -sl.var_16, sl.var_15./sl.v_app; 
     ylabels=["- rel_steering", "turnrate/v_app [°/m]"],
-    ylims=[(-0.6, 0.6), (-100, 100)],
+    ylims=[(-0.6, 0.6), (-5, 5)],
     fig="steering vs turnrate")
-    p2=plot(sl.time, sl.v_app; ylabel="v_app [m/s]", fig="v_app")
+    # p2=plot(sl.time, sl.v_app; ylabel="v_app [m/s]", fig="v_app")
+    G = -sl.var_15./sl.v_app./sl.var_16
+    for (i, g) in enumerate(G)
+        if abs(sl.var_16[i]) < 0.099
+            G[i] = 0
+        end
+    end
+    p2=plot(sl.time, G; ylabel="G [-]", fig="turnrate_law")
     display(p1); display(p2)
 end