Started autonomous

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