Changes to get robot to a useable state. Very rough, more work required.
Merge branch 'origin/master'
Made the winching automatic.
Added winch timeout.
Modified stuff to make it work better.
Merge pull request #28 from BitBucketsFRC4183/robotTest

Merge robotTest into master.