Browse Source

attitude_estimator_ekf: fixed quaternion computation from dcm

Signed-off-by: Roman <bapstroman@gmail.com>
sbg
Roman 8 years ago committed by Lorenz Meier
parent
commit
7cb06c01eb
  1. 2
      src/examples/attitude_estimator_ekf/attitude_estimator_ekf_main.cpp

2
src/examples/attitude_estimator_ekf/attitude_estimator_ekf_main.cpp

@ -614,7 +614,7 @@ int attitude_estimator_ekf_thread_main(int argc, char *argv[]) @@ -614,7 +614,7 @@ int attitude_estimator_ekf_thread_main(int argc, char *argv[])
matrix::Dcmf Ro(&Rot_matrix[0]);
matrix::Dcmf R_declination(&R_decl.data[0][0]);
Ro = R_declination * Ro;
matrix::Quatf q = R_declination * Ro;
matrix::Quatf q = matrix::Quatf(R_declination * Ro);
memcpy(&att.q[0],&q._data[0],sizeof(att.q));

Loading…
Cancel
Save