基于圆弧转接和跨段前瞻的拾放操作轨迹规划

摘要

针对工业机器人拾放操作中末端速度不连续及突变的问题,设计了一种利用圆弧转接的轨迹规划算法。以给定路径点和圆弧半径为基准,建立了拐角处圆弧转接数学模型,并推导出分割后的路径段计算公式。路径段采用非对称S型加减速模型,在路径长度及始末速度约束下的,计算得到最优的转接速度。根据在路径段内能否达到最大速度和最大加速度,分4种情况进行跨段前瞻速度规划,并采用弧长增量法插补技术实现轨迹规划。在六自由度机器人实时控制平台上进行了三角式和门式拾放操作实验。结果表明,该算法可实现拾放路径拐角处速度的平滑过渡,减少加速度突变,提高机器人作业效率。