Updated test

test/test_fpc_low_right.jl

@@ -11,6 +11,7 @@ if false; include("../src/flightpathcalculator2.jl"); end
 # 1. use initial condition from failure_low_right.arrow at 226.0s
 # 2. fly towards attractor point P1
 # 3. update u_d and v_reelout from logfile
+# test fails if we allow v_ro > 0
 
 using KiteUtils
 using KiteControllers, KiteModels, KiteViewers, ControlPlots
@@ -67,11 +68,13 @@ function simulate(integrator)
         KiteControllers.set_azimuth_elevation(fpca, phi, beta)
         omega = fpca._omega
         # println("omega: $omega")
-        on_est_sysstate(fpc, -phi, beta, -psi, -chi, omega, v_a; u_d=u_d)
+        println("phi: ", rad2deg(phi))
+        on_est_sysstate(fpc, phi, beta, -psi, -chi, omega, v_a; u_d=u_d)
         steering = calc_steering(fpc, false)
         on_timer(fpc)
         set_depower_steering(kps4.kcu, u_d, steering)
         v_ro = sl[I_START+i-1].v_reelout
+        v_ro = -1
         KiteModels.next_step!(kps4, integrator, v_ro=v_ro, dt=dt)
         sys_state = SysState(kps4)
         KiteViewers.update_system(viewer, sys_state; scale = 0.04/1.1, kite_scale=set.kite_scale)