updated kalman 4 to write periodically
Merge branch 'master' of https://github.com/lwthatcher/CS-470