Delta机器人拾放操作门型轨迹优化与ANPD控制试验

摘要

为实现Delta机器人稳定快速拾放作业,基于次数和长短轴可变的3参数Lamé曲线构造笛卡尔空间门型运动轨迹,采用非对称6次多项式规划门型路径的运动规律,推导离散时间下的位移、速度和加速度公式.为进一步平滑运动轨迹,以关节力矩变化率均值为优化目标,采用遗传算法对Lamé曲线的3个参数进行综合优化,提出Lamé曲线次数的选取方法.在此基础上,通过引入一类饱和非线性函数设计Delta机器人增广非线性PD (ANPD)控制器,对自主设计的机器人开展控制试验.结果表明,该轨迹优化方法能获得平滑运动轨迹,机器人轨迹跟踪误差小,重复定位精度高.