Added functionality for two arms, fixed a few bugs.
Camera memory leaks should be gone, winch is still nonfunctional. Added new control scheme; that needs to be tested.