Revert "updated drive roboteq controller to use effort instead of velocity"

This reverts commit 3f817b63112e3de395f83cdeb77b099415b8b3fc.