https://123dok.org/document/q5mn7x83-ill-conditioning-on-kalman-filter-state-estimation.html