Fixed some issues with autonomous

- Changed distance constants