First pass Kalman filter for filtering manipulator sample detections

This compiles and runs, but doesn't produce useful data yet
New manipulator calibration