Fixed auto drive and added prints and fixed auto driving