Use square root estimate in Cholesky decomposition

With X8 dynamics model, in release configuration, this change reduces UKF CPU usage from 426,000 cycles per iteration to 421,000 cycles per iteration.