Adjusted drive code, added input debug