Update armControl Class

Added mode enum, added ability to actually move the arms!