Added code to control the  temporary winch set up

This should be removed as soon as possible with some properly designed
code. And some safety. -Adam
Added the motors for the arm, two Gyros and an Accelerometer