Implements a lot of the KalmanPositionTracker functionality.
Refactors to add a PositionTracker parent class for all position trackers.