Browse Source

AP_NavEKF3: remove unused getAccelNED method

c415-sdk
Peter Barker 4 years ago committed by Peter Barker
parent
commit
5ad0ac6727
  1. 8
      libraries/AP_NavEKF3/AP_NavEKF3.cpp
  2. 3
      libraries/AP_NavEKF3/AP_NavEKF3.h
  3. 6
      libraries/AP_NavEKF3/AP_NavEKF3_Outputs.cpp
  4. 3
      libraries/AP_NavEKF3/AP_NavEKF3_core.h

8
libraries/AP_NavEKF3/AP_NavEKF3.cpp

@ -1170,14 +1170,6 @@ float NavEKF3::getPosDownDerivative(int8_t instance) const
return 0.0f; return 0.0f;
} }
// This returns the specific forces in the NED frame
void NavEKF3::getAccelNED(Vector3f &accelNED) const
{
if (core) {
core[primary].getAccelNED(accelNED);
}
}
// return body axis gyro bias estimates in rad/sec // return body axis gyro bias estimates in rad/sec
void NavEKF3::getGyroBias(int8_t instance, Vector3f &gyroBias) const void NavEKF3::getGyroBias(int8_t instance, Vector3f &gyroBias) const
{ {

3
libraries/AP_NavEKF3/AP_NavEKF3.h

@ -93,9 +93,6 @@ public:
// but will always be kinematically consistent with the z component of the EKF position state // but will always be kinematically consistent with the z component of the EKF position state
float getPosDownDerivative(int8_t instance) const; float getPosDownDerivative(int8_t instance) const;
// This returns the specific forces in the NED frame
void getAccelNED(Vector3f &accelNED) const;
// return body axis gyro bias estimates in rad/sec for the specified instance // return body axis gyro bias estimates in rad/sec for the specified instance
// An out of range instance (eg -1) returns data for the primary instance // An out of range instance (eg -1) returns data for the primary instance
void getGyroBias(int8_t instance, Vector3f &gyroBias) const; void getGyroBias(int8_t instance, Vector3f &gyroBias) const;

6
libraries/AP_NavEKF3/AP_NavEKF3_Outputs.cpp

@ -216,12 +216,6 @@ float NavEKF3_core::getPosDownDerivative(void) const
return vertCompFiltState.vel + velOffsetNED.z; return vertCompFiltState.vel + velOffsetNED.z;
} }
// This returns the specific forces in the NED frame
void NavEKF3_core::getAccelNED(Vector3f &accelNED) const {
accelNED = velDotNED;
accelNED.z -= GRAVITY_MSS;
}
// Write the last estimated NE position of the body frame origin relative to the reference point (m). // Write the last estimated NE position of the body frame origin relative to the reference point (m).
// Return true if the estimate is valid // Return true if the estimate is valid
bool NavEKF3_core::getPosNE(Vector2f &posNE) const bool NavEKF3_core::getPosNE(Vector2f &posNE) const

3
libraries/AP_NavEKF3/AP_NavEKF3_core.h

@ -125,9 +125,6 @@ public:
// but will always be kinematically consistent with the z component of the EKF position state // but will always be kinematically consistent with the z component of the EKF position state
float getPosDownDerivative(void) const; float getPosDownDerivative(void) const;
// This returns the specific forces in the NED frame
void getAccelNED(Vector3f &accelNED) const;
// return body axis gyro bias estimates in rad/sec // return body axis gyro bias estimates in rad/sec
void getGyroBias(Vector3f &gyroBias) const; void getGyroBias(Vector3f &gyroBias) const;

Loading…
Cancel
Save