--Minor correction to autodrive localization.  Added waypoint logging to imu-log file.