kalman plot added
Merge branch 'cam' of https://github.com/camhart/potentialfields into cam