old ekf: fix computation of rotation matrix

Signed-off-by: Roman <bapstroman@gmail.com>
This commit is contained in:
Roman 2016-10-09 20:03:30 +02:00 committed by Lorenz Meier
parent 7c2ebd96a0
commit 17a4b64434
1 changed files with 0 additions and 1 deletions

View File

@ -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));