Skip to content
Snippets Groups Projects
Commit 66fe3ab5 authored by Paul Riseborough's avatar Paul Riseborough Committed by Lorenz Meier
Browse files

ekf2: Use corrected local position and velocity

Corrects for IMU offset from body frame origin
parent 43e56f9f
No related branches found
No related tags found
No related merge requests found
......@@ -580,13 +580,13 @@ void Ekf2::task_main()
lpos.timestamp = hrt_absolute_time();
// Position in local NED frame
// Position of body origin in local NED frame
_ekf->get_position(pos);
lpos.x = pos[0];
lpos.y = pos[1];
lpos.z = pos[2];
// Velocity in NED frame (m/s)
// Velocity of body origin in local NED frame (m/s)
_ekf->get_velocity(vel);
lpos.vx = vel[0];
lpos.vy = vel[1];
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment