updated drive roboteq controller to use effort instead of velocity