Major overhaul of EKF to add velocity to the state.

Everything in ekf.py except the prediction step is done.
Convert the main localization.py file to the new EKF.
Update the prediction step of the EKF.
Missed the import of concatenate.
Squish a few bugs.
Merge branch 'ekf'
Start adding code to use odom position data again.