Compensation of velocity and/or acceleration joint saturation applied to redundant manipulator