9 Commits

Author SHA1 Message Date
Paul Riseborough
edfb7aefcc EKF: Fix initial alignment errors
Use the gravity vector to estimate the initial roll and pitch angle
Use the projection of the magnetic field measurement onto the earth axis horizontal plane to calculate the initial heading
2016-01-03 00:03:03 +11:00
Lorenz Meier
eda69e727f Do not print states by default 2015-12-24 13:48:22 +01:00
Roman
457a57c6ff use simple heading fusion 2015-12-22 18:00:59 +01:00
Roman
5e5d6f432a added static gps mode and init mag state correctly 2015-12-22 11:22:17 +01:00
Roman Bapst
d233ca3990 added complementary filter for real time state estimation 2015-12-10 16:36:10 +01:00
Roman Bapst
67646a15b0 added full mag fusion 2015-12-10 09:07:00 +01:00
Roman
8de8b0eb76 prediction and vel pos heading fusion working 2015-12-09 17:47:52 +01:00
Roman
cfc39bc2f9 implemented prediction of states and covariance matrix 2015-12-07 22:41:11 +01:00
Roman Bapst
144aa9c461 added base class for data storage 2015-12-05 11:08:06 +01:00