关节型码垛机器人轨迹规划及运动学研究

简介

为了使关节型码垛机器人运动更加精确、流畅、连续、平稳的码放货物,提出了基于双平行四边形机构码垛机器人的轨迹规划及运动学分析方法。根据D-H法建立运动学模型,并对其进行反解。采用“5-3-5”轨迹规划法,将各关节运动轨迹分为三段,使用不同低阶多项式对各轨迹段进行插补。利用MATLAB进行运动学仿真分析,并生成关节角、角速度、角加速度变化曲线。利用拉格朗日方程推导各关节驱动力矩,保证各关节按照期望的角速度和角加速度运动。为实现关节型码垛机器人轨迹规划提出一种新的方法。