Skip to content

Commit 677039d

Browse files
committed
Removing use of BodyToGlobal in ekf
1 parent 2a57a44 commit 677039d

File tree

1 file changed

+2
-2
lines changed

1 file changed

+2
-2
lines changed

MIDAS/src/gnc/ekf.cpp

Lines changed: 2 additions & 2 deletions
Original file line numberDiff line numberDiff line change
@@ -80,8 +80,8 @@ void EKF::priori(float dt, AngularKalmanData &orientation, FSMState fsm, Acceler
8080
sensor_accel_global_g(0, 0) = acceleration.ax ;
8181
sensor_accel_global_g(1, 0) = acceleration.ay ;
8282
sensor_accel_global_g(2, 0) = acceleration.az ;
83-
euler_t angles_rad = orientation.getEuler();
84-
BodyToGlobal(angles_rad, sensor_accel_global_g);
83+
// euler_t angles_rad = orientation.getEuler();
84+
// BodyToGlobal(angles_rad, sensor_accel_global_g);
8585
// Do not apply acceleration if on pad
8686
float g_ms2 = (fsm > FSMState::STATE_IDLE) ? gravity_ms2 : 0.0f;
8787
u_control(0, 0) = sensor_accel_global_g(0, 0) * g_ms2;

0 commit comments

Comments
 (0)