四关节机器人的运动建模与控制

采用D-H后置法建立了4R机器人运动方程,建立机器人执行机构在空间相对位置关系的数学模型,由此可解出手部位置和用单位矢量方向余弦表示的姿态。同时还讨论了机器人轨迹规划的方法,以便在编制机器人控制器的控制软件时应用,并给出了基于DSP的三级CPU控制的控制器系统设计方案。