--Got waypoint logging in imu-log to work.  Also added robot's own location estimate to imu-log