Refactor of UKF, plus bug fix.

There are too many different UKF algorithms out there for my OO apprach
to work. So, I wrote a different class for the two types I currently
approach.

There was a bad bug where I had my weight parameters reversed in the
call to unscented_transform, causing the P matrix to become not
positive definite.