controls for all joints and wheels, still need to fix disabled feel of the robot