cwrucutter / snowmower_localization

An EFK for the snowmower.
MIT License
1 stars 1 forks source link

Debug occurrence of occasional explosion of NaN/Inf during EKF updates. #45

Open kleinma opened 7 years ago

kleinma commented 7 years ago

I believe that they occur during the .inverse() operation when calculating the Kalman gain. ex: https://github.com/cwrucutter/snowmower_localization/blob/a28ae8a872298ad1bc126b1ba2659f0cdc5daadc/src/ekf.cpp#L315

Other possibilities are a division by zero or a square root of a negative number. However, I think I have ruled out these possibilities.