Changed some autonomous control code