Changed position to use routes and track the position; cleaned up debugger features; general calibration/positioning improvements