Separate matrix test from ukf test,
Separate matrix test from ukf test,

- Remove redundant matrix/array xt
- separate matrix test from ukf test in different functions
- add some comments
ivo-georgiev/ukfLib,ivo-georgiev/ukfLib