Fixed to mag measurement and filter

This commit is contained in:
Lorenz Meier
2012-09-07 16:56:47 +02:00
parent 297990fe35
commit c25cef299f
3 changed files with 6 additions and 23 deletions
@@ -226,7 +226,7 @@ int attitude_estimator_bm_main(int argc, char *argv[])
att.timestamp = sensor_combined_s_local.timestamp;
att.roll = euler.x;
att.pitch = euler.y;
att.yaw = euler.z - M_PI_F;
att.yaw = euler.z;
if (att.yaw > M_PI_F) {
att.yaw -= 2.0f * M_PI_F;