Started working on a prototype version of the autonomous logic, based on cartesian and drive distances