六自由度机器人控制系统