Plot force

Co-authored-by: Copilot <copilot@github.com>

Author: ufechner7

examples/parking_wind_dir.jl

@@ -94,6 +94,7 @@ AZIMUTH_EAST::Vector{Float64}  = zeros(Int64(MAX_TIME/dt))
 UPWIND_DIR_::Vector{Float64}   = zeros(Int64(MAX_TIME/dt))
 AV_UPWIND_DIR::Vector{Float64} = zeros(Int64(MAX_TIME/dt))
 V_WIND_KITE::Vector{Float64}   = zeros(Int64(MAX_TIME/dt))
+FORCE::Vector{Float64}         = zeros(Int64(MAX_TIME/dt))
 HEADING::Vector{Float64}       = zeros(Int64(MAX_TIME/dt))
 SET_STEERING::Vector{Float64}  = zeros(Int64(MAX_TIME/dt))
 STEERING::Vector{Float64}      = zeros(Int64(MAX_TIME/dt))
@@ -149,6 +150,7 @@ function sim_parking(integrator)
         T[i] = dt * i
         AZIMUTH[i] = sys_state.azimuth
         AZIMUTH_EAST[i] = calc_azimuth_east(kps4)
+        FORCE[i] = sys_state.winch_force[1]
         HEADING[i] = wrap2pi(sys_state.heading)
         on_new_systate(ssc, sys_state)
         if mod(i, TIME_LAPSE_RATIO) == 0
@@ -210,10 +212,10 @@ end
 play_parking()
 stop(viewer)
 p=plotx(T, rad2deg.(AZIMUTH), rad2deg.(AZIMUTH_EAST),[rad2deg.(UPWIND_DIR_), rad2deg.(AV_UPWIND_DIR)],
-         rad2deg.(HEADING), [100*(SET_STEERING), 100*(STEERING)], V_WIND_KITE; 
+         rad2deg.(HEADING), [100*(SET_STEERING), 100*(STEERING)], V_WIND_KITE, FORCE; 
          xlabel="Time [s]", 
-         ylabels=["Azimuth [°]", "azimuth_east [°]", "upwind_dir [°]", "Heading [°]", "Steering [%]", "v_wind_kite [m/s]"],
-         labels=["azimuth", "azimuth_east", ["upwind_dir", "filtered_upwind_dir"], "heading", ["set_steering", "steering"], "v_wind_kite"])
+         ylabels=["Azimuth [°]", "azimuth_east [°]", "upwind_dir [°]", "Heading [°]", "Steering [%]", "v_wind_kite [m/s]", "force [N]"],
+         labels=["azimuth", "azimuth_east", ["upwind_dir", "filtered_upwind_dir"], "heading", ["set_steering", "steering"], "v_wind_kite", "force"])
 display(p)
 reactivate_host_app()