Skip to content
Snippets Groups Projects
Commit 17a4b644 authored by Roman's avatar Roman Committed by Lorenz Meier
Browse files

old ekf: fix computation of rotation matrix


Signed-off-by: default avatarRoman <bapstroman@gmail.com>
parent 7c2ebd96
No related branches found
No related tags found
No related merge requests found
......@@ -613,7 +613,6 @@ int attitude_estimator_ekf_thread_main(int argc, char *argv[])
/* magnetic declination */
matrix::Dcmf Ro(&Rot_matrix[0]);
matrix::Dcmf R_declination(&R_decl.data[0][0]);
Ro = R_declination * Ro;
matrix::Quatf q = matrix::Quatf(R_declination * Ro);
memcpy(&att.q[0],&q._data[0],sizeof(att.q));
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment