Officially functional

Fixed winch and loader issues: winch hold is now a command and loader
double solenoid is hard coded to ports 4 and 5. The robot officially
works!