Added winch to robot; fixed timing bugs in autonomous mode