计算机集成制造系统 ›› 2019, Vol. 25 ›› Issue (第10): 2648-2654.DOI: 10.13196/j.cims.2019.10.023

• 当期目次 • 上一篇    下一篇

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

王涛1,2,陈立2,郭振武1,王斌锐1+,李振娜1   

  1. 1.中国计量大学机电工程学院
    2.杭州新松机器人自动化有限公司
  • 出版日期:2019-10-31 发布日期:2019-10-31
  • 基金资助:
    国家重点研发计划课题资助项目(2018YFC0809204)。

Pick-and-place trajectory planning for based on arc transition and cross-section look-ahead

  • Online:2019-10-31 Published:2019-10-31
  • Supported by:
    Project supported by the National Key Research and Development Plan,China(No.2018YFC0809204).

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

关键词: 工业机器人, 圆弧转接, 拾放操作, 非对称S曲线, 轨迹规划, 平滑过渡

Abstract: Aiming at the discontinuity and abrupt change of tip velocity in pick-and-place operation of industrial robots,a trajectory planning algorithm based on arc transition was designed.Based on the given path point and arc radius,a mathematic model of arc transfer at the corner was established and the formula of path segment after segmentation was deduced.The asymmetric S-shaped acceleration and deceleration model was adopted in the path segment,and the optimal transfer speed was calculated under speed constraints.According to the situation that the maximum speed and the maximum acceleration could be reached or not in the path segment,the cross-section look-ahead speed planning was carried out in four cases.The arc length increment interpolation method was adopted to achieve trajectory planning.Triangular and gantry pick-and-place operation experiments were carried out on a 6-DOF real-time control platform.The results showed that the proposed algorithm could realize the smooth transition of speed at the corner of pick-and-place path,reduce the sudden change of acceleration and improve the task efficiency of robot.

Key words: industrial robot, space arc transfer, pick-and-place operation, asymmetrical S-curve, trajectory planning, smooth transition

中图分类号: