--First autodrive route test successful.  Found error in logging of waypoints, recorded estimate instead of point itself.  Fixed.  Measured MSE and distance error, mean MSE over 6 runs was 0.66cm, mean distance error over 6 runs was 3.84cm.