Browse Source

Merge pull request #845 from PX4/mag_decl_hotfix

Mag declination hotfix
sbg
Lorenz Meier 11 years ago
parent
commit
5bd8e6f6b3
  1. 2
      src/modules/attitude_estimator_ekf/attitude_estimator_ekf_params.c

2
src/modules/attitude_estimator_ekf/attitude_estimator_ekf_params.c

@ -40,6 +40,7 @@
*/ */
#include "attitude_estimator_ekf_params.h" #include "attitude_estimator_ekf_params.h"
#include <math.h>
/* Extended Kalman Filter covariances */ /* Extended Kalman Filter covariances */
@ -113,6 +114,7 @@ int parameters_update(const struct attitude_estimator_ekf_param_handles *h, stru
param_get(h->yaw_off, &(p->yaw_off)); param_get(h->yaw_off, &(p->yaw_off));
param_get(h->mag_decl, &(p->mag_decl)); param_get(h->mag_decl, &(p->mag_decl));
p->mag_decl *= M_PI / 180.0f;
param_get(h->acc_comp, &(p->acc_comp)); param_get(h->acc_comp, &(p->acc_comp));

Loading…
Cancel
Save