forked from Archive/PX4-Autopilot
old ekf: fix computation of rotation matrix
Signed-off-by: Roman <bapstroman@gmail.com>
This commit is contained in:
parent
7c2ebd96a0
commit
17a4b64434
|
@ -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));
|
||||
|
|
Loading…
Reference in New Issue