Added arm controller, still needs some work