Started autonomous

Added PID, encoders, winch.  Started the basis for the autonomous.
Fixed Autonomous

enabled PIDControllers
Merge pull request #8 from TrojanRobotics/Autonomous

Started autonomous