mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-30 20:13:34 +08:00
Refactor velocity reset (#788)
* Refactor velocity reset * Add unit tests for velocity resets * Expand updates to vertical buffer to velocity resets outside of resetHeight * Improve matrix library usage * Improve naming of vertical output samples * Fix update of output_vert_new during reset * Improve naming of vertical output samples 2
This commit is contained in:
@@ -302,7 +302,7 @@ public:
|
||||
// get the derivative of the vertical position of the body frame origin in local NED earth frame
|
||||
float getVerticalPositionDerivative() const
|
||||
{
|
||||
return _output_vert_new.vel_d - _vel_imu_rel_body_ned(2);
|
||||
return _output_vert_new.vert_vel - _vel_imu_rel_body_ned(2);
|
||||
}
|
||||
|
||||
// get the position of the body frame origin in local earth frame
|
||||
|
||||
Reference in New Issue
Block a user