Started working on the autonomous code with zayd, sensor is added and working