slow kalman filter estimate
small changes to kf1. still slow.
predict1.py and other support and test code
Merge remote-tracking branch 'origin/brian'