added in code to control the winch
added in the close loop frive contol and eliminated the example susyetem and command
added in the auton commands, changed wich side of the robot is forward and added the toggle pimp buton
final revisions of code after DDU