Feed SLAM Data into EKF to better approximate local coordinates

[jkleiber]

Whatever SLAM algorithm we choose needs a good pose estimator so we can use it as part of the localization system. The SLAM pose can be fed into the EKF in addition to the dead reckoning we already have. This should increase the EKF's accuracy.