Fixed the steering unit tests as well as some stupidity in drive.py