六自由度机械臂控制系统设计与运动学仿真