dark0707
/
px4-firmware
forked from Archive/PX4-Autopilot
1
0
Fork 0
Code Pull Requests Activity

Fixed param issue.

This commit is contained in:
James Goppert 2013-01-15 11:16:28 -05:00
parent d02a24ec82
commit 8b6660fc36
1 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
apps/examples/kalman_demo/KalmanNav.cpp
View File

@ -475,8 +475,8 @@ void KalmanNav::correctAtt()
// mag predicted measurement
// choosing some typical magnetic field properties,
// TODO dip/dec depend on lat/ lon/ time
static const float dip = _magDip.get() / M_RAD_TO_DEG_F; // dip, inclination with level
static const float dec = _magDec.get() / M_RAD_TO_DEG_F; // declination, clockwise rotation from north
float dip = _magDip.get() / M_RAD_TO_DEG_F; // dip, inclination with level
float dec = _magDec.get() / M_RAD_TO_DEG_F; // declination, clockwise rotation from north
float bN = cosf(dip) * cosf(dec);
float bE = cosf(dip) * sinf(dec);
float bD = sinf(dip);