From d677ae9739a170f137b64ef3c5ba4dbe44126074 Mon Sep 17 00:00:00 2001
From: Stefano Belletti <stefano.belletti@skywarder.eu>
Date: Sat, 30 Nov 2024 18:54:18 +0100
Subject: [PATCH] Small fix, print data
---
simulator/src/std_run.m | 9 ++++++---
1 file changed, 6 insertions(+), 3 deletions(-)
diff --git a/simulator/src/std_run.m b/simulator/src/std_run.m
index c29d271..31c5728 100644
--- a/simulator/src/std_run.m
+++ b/simulator/src/std_run.m
@@ -555,11 +555,14 @@ while settings.flagStopIntegration && n_old < nmax % St
if not(settings.montecarlo)
if settings.flagAscent
- disp("z: " + (-Yf(end,3)+environment.z0) +", z_est: " + -sensorData.kalman.z + ", ap_ref: " + ap_ref_new + ", ap_ode: " + Yf(end,14)); % + ", quatNorm: "+ vecnorm(Yf(end,10:13))
+ fprintf("z: %4.4f, z_est: %4.4f, ap_ref: %4.4f, ap_ode: %4.4f\n", (-Yf(end,3)+environment.z0), -sensorData.kalman.z, ap_ref_new, Yf(end,14))
+ % disp("z: " + (-Yf(end,3)+environment.z0) +", z_est: " + -sensorData.kalman.z + ", ap_ref: " + ap_ref_new + ", ap_ode: " + Yf(end,14)); % + ", quatNorm: "+ vecnorm(Yf(end,10:13))
elseif currentState == availableStates.payload_descent
- disp("z: " + (-Yf(end,3)+environment.z0) +", z_est: " + -sensorData.kalman.z + ", deltaA_ref: " + deltaA_ref_new + ", deltaA_ode: " + Yf(end,15)); % +", quatNorm: "+ vecnorm(Yf(end,10:13))
+ fprintf("z: %4.4f, z_est: %4.4f, deltaA_ref: %4.4f, deltaA_ode: %4.4f\n", (-Yf(end,3)+environment.z0), -sensorData.kalman.z, deltaA_ref_new, Yf(end,15))
+ % disp("z: " + (-Yf(end,3)+environment.z0) +", z_est: " + -sensorData.kalman.z + ", deltaA_ref: " + deltaA_ref_new + ", deltaA_ode: " + Yf(end,15)); % +", quatNorm: "+ vecnorm(Yf(end,10:13))
else
- disp("z: " + (-Yf(end,3)+environment.z0) +", z_est: " + -sensorData.kalman.z);
+ fprintf("z: %4.4f, z_est: %4.4f\n", (-Yf(end,3)+environment.z0), -sensorData.kalman.z)
+ % disp("z: " + (-Yf(end,3)+environment.z0) +", z_est: " + -sensorData.kalman.z);
end
end
--
GitLab