Skip to content

Fake GPS Velocity Frame Issue #1719

Open
@jgoppert

Description

@jgoppert

We are using fake GPS on PX4 and noticed that we get drift and high velocity residuals. We are still testing further, but suspect these lines. The velocity is calculated using a single step finite difference approximation. vel = ([pos[t_1] - pos[t_0]) / dt. The problem is that the frame is incorrect. These positions are in earth centered, earth fixed coordinates. This is not the north east down coordinate system. As soon as we move from hover, our residuals spike. We will submit a patch after test flying it.

Eigen::Vector3d vel = (old_ecef - current_ecef) / (stamp.seconds() - old_stamp); // [m/s]

hil_gps.vn = vel.x(); // [cm/s]

image

image

image

MAVROS version and platform

Mavros: Master
ROS: Noetic
Ubuntu: 20.04

Metadata

Metadata

Assignees

Labels

Type

No type

Projects

No projects

Milestone

No milestone

Relationships

None yet

Development

No branches or pull requests

Issue actions