Changed some speed and autonomous code