Browse Source

Changed fault tolerances.

sbg
James Goppert 12 years ago
parent
commit
63e6ea1b95
  1. 4
      apps/examples/kalman_demo/KalmanNav.cpp

4
apps/examples/kalman_demo/KalmanNav.cpp

@ -579,7 +579,7 @@ void KalmanNav::correctAtt() @@ -579,7 +579,7 @@ void KalmanNav::correctAtt()
// fault detection
float beta = y.dot(S.inverse() * y);
if (beta > 10.0f) {
if (beta > 1000.0f) {
printf("fault in attitude: beta = %8.4f\n", (double)beta);
//printf("y:\n"); y.print();
}
@ -652,7 +652,7 @@ void KalmanNav::correctPos() @@ -652,7 +652,7 @@ void KalmanNav::correctPos()
// fault detetcion
float beta = y.dot(S.inverse() * y);
if (beta > 10.0f) {
if (beta > 1000.0f) {
printf("fault in gps: beta = %8.4f\n", (double)beta);
//printf("y:\n"); y.print();
}

Loading…
Cancel
Save