双关节机械臂+机械爪运动控制