Wrote a motorControl class that simplifies the armController code.