Added stats code from the Kalman filter book.
Changed UKF implementation.

UKF is much more robust now. May not be in its final form; I don't entirely
like how I handle the different ways of computing the sigma points.