Interim check in.

Converted from np.mat to np.array, and reversed dimensions of arrays to
avoid all of the xi[:,i] slicing. Tested with the Radar tracking problem
and verified it is working.

Need to structure unit tests better. right now they are in the same
file as the implementation. Ugly.
Merge branch 'master' of https://github.com/rlabbe/filterpy