Encoders Working and AutoDrive added.

Need Preferences and testing.
Added Auto Winch and Auto Drive and got Encoders working