六自由度机器人运动控制及轨迹规划研究.pdf