mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-16 05:13:33 +08:00
Remove unnecessary operations
This commit is contained in:
committed by
Mathieu Bresciani
parent
079a699556
commit
3e3a66e9e9
@@ -222,7 +222,6 @@ void Ekf::predictCovariance()
|
||||
|
||||
// Construct the process noise variance diagonal for those states with a stationary process model
|
||||
// These are kinematic states and their error growth is controlled separately by the IMU noise variances
|
||||
process_noise.slice<10,1>(0,0) = 0.0f;
|
||||
|
||||
// delta angle bias states
|
||||
process_noise.slice<3,1>(10,0) = sq(d_ang_bias_sig);
|
||||
@@ -423,11 +422,6 @@ void Ekf::predictCovariance()
|
||||
nextP(11,12) = P(11,12);
|
||||
nextP(12,12) = P(12,12);
|
||||
|
||||
// add process noise that is not from the IMU
|
||||
for (unsigned i = 0; i <= 9; i++) {
|
||||
nextP(i,i) += process_noise(i);
|
||||
}
|
||||
|
||||
// process noise contribution for delta angle states can be very small compared to
|
||||
// the variances, therefore use algorithm to minimise numerical error
|
||||
for (unsigned i = 10; i <=12; i++) {
|
||||
|
||||
Reference in New Issue
Block a user