Clean Up

Removed the non-linear LKT stuff and the imu pipeline. Its all in
version control so just go back here if you want it.
Incorporate IMU and odometry information

Calculates fake odometry and IMU-based pose information and uses them to
estimate position.