Added winch functionality
Merge pull request #3 from CircuitOfLifeRobotics/winchcode

Added winch functionality