error fix

2 sensor, full rate, T2TFwoMff, det(P) too small
change parameters