changed control system. we still need to add motor controls for arm with encoder