vehicle_global_position delete unused pos_d_deriv

This commit is contained in:
Daniel Agar
2018-03-05 01:06:55 -05:00
parent 2ddd04cba6
commit b9081fb0ab
4 changed files with 0 additions and 10 deletions
-2
View File
@@ -17,8 +17,6 @@ float32 vel_n # North velocity in NED earth-fixed frame, (metres/sec)
float32 vel_e # East velocity in NED earth-fixed frame, (metres/sec)
float32 vel_d # Down velocity in NED earth-fixed frame, (metres/sec)
float32 pos_d_deriv # Down position time derivative in NED earth-fixed frame, (metres/sec)
float32 yaw # Euler yaw angle relative to NED earth-fixed frame, -PI..+PI, (radians)
float32 eph # Standard deviation of horizontal position error, (metres)
-2
View File
@@ -1048,8 +1048,6 @@ void Ekf2::run()
global_pos.vel_e = lpos.vy; // Ground east velocity, m/s
global_pos.vel_d = lpos.vz; // Ground downside velocity, m/s
global_pos.pos_d_deriv = lpos.z_deriv; // vertical position time derivative, m/s
global_pos.yaw = lpos.yaw; // Yaw in radians -PI..+PI.
_ekf.get_ekf_gpos_accuracy(&global_pos.eph, &global_pos.epv, &global_pos.dead_reckoning);
@@ -721,9 +721,6 @@ void BlockLocalPositionEstimator::publishGlobalPos()
_pub_gpos.get().vel_e = xLP(X_vy);
_pub_gpos.get().vel_d = xLP(X_vz);
// this estimator does not provide a separate vertical position time derivative estimate, so use the vertical velocity
_pub_gpos.get().pos_d_deriv = xLP(X_vz);
_pub_gpos.get().yaw = _eul(2);
_pub_gpos.get().eph = eph;
_pub_gpos.get().epv = epv;
@@ -1392,9 +1392,6 @@ int position_estimator_inav_thread_main(int argc, char *argv[])
global_pos.vel_e = local_pos.vy;
global_pos.vel_d = local_pos.vz;
// this estimator does not provide a separate vertical position time derivative estimate, so use the vertical velocity
global_pos.pos_d_deriv = local_pos.vz;
global_pos.yaw = local_pos.yaw;
global_pos.eph = eph;