六自由度机械手运动控制