Made the test for the square root kalman filter check compare all elements of P, not just the diagonal.
Made the test for the square root kalman filter check compare all elements of P, not just the diagonal.

rlabbe/filterpy,rlabbe/filterpy