Resolved most issues with reversed motor dirs
Commented out obsolete code
Fixed turning bug