冲压线搬运机器人防碰撞控制方法
【技术领域】
[0001] 本发明涉及液压自动控制领域，特别是涉及一种冲压线搬运机器人防碰撞控制方 法。
【背景技术】
[0002] 机器人离线编程技术是工业机器人技术的一个重要研宄领域，该技术是在离 线仿真的环境下进行机器人生产线的可行性评估。通过使用离线编程技术可提高工业 机器人工作效率、并增加机器人使用过程中的安全性。在离线编程技术中碰撞检测技 术及避障路径规划技术对于将机器人仿真结果应用于工程实际极为重要。《一种工业机 器人手臂快速碰撞检测算法》作者：凌家良，施荣华，王国才；期刊《山西电子技术》，出 版时间：2009,（3) :34-37通过比较层次包围盒法、空间分割法等三维空间物体的简化包 络方法优劣，提出将机器人杆件简化为两端半球体、中间圆柱体的空间图形，然后通过 将三维物体的干涉问题转化为二维问题进行机器人各杆件间的碰撞检测。《一种优化的 机器人碰撞检测算法研宄》，作者：刘燕，陈一民，李启明等，期刊《微型电脑应用》出版时 间，2011，27(5) :14-18.D0I:10. 3969/j.issn. 1007-757X. 2011. 05. 005 采用AABB包装盒进 行空间物体的模型简化，并提出Vclip的优化碰撞检测算法，用GPU的遮挡查询特性进行 三角形测试，从而提高了虚拟物体碰撞检测精确性与计算速度。《一种多臂机器人关节间碰 撞检测快速算法》，作者：黎自强，滕弘飞，期刊《大连理工大学学报》，出版时间2007,47 (4): 527-532利用圆柱体简化机器人关节，通过二元函数极小值算法求出圆柱体间最短距离进 行碰撞检测。
【发明内容】
[0003] 本发明要解决的技术问题是：本专利针对机器人将工件搬运进入锻压机内腔过程 中的碰撞检测问题为对象，进行了冲压线机器人碰撞检测算法研宄和机器人无碰路径规划 仿真。为了提高碰撞检测效率，采用AABB包围盒的方法，对液压件支柱和机器人关节轴进 行简化包络，并进行求解仿真。其次，针对单工位机器人抓取模型进行无碰路径规划和仿 真。最后，将规划好的机器人无碰路径进行仿真和现场验证，仿真结果表示该避障策略正 确，该避障策略将为机器人离线编程提供重要的理论依据。
[0004] 本发明为解决公知技术中存在的技术问题所采取的技术方案是：
[0005] 一种冲压线搬运机器人防碰撞控制方法，包括如下步骤：
[0006] 步骤101、基于AABB包围盒法建立机器人关节轴包络模型和锻压机简化包络模 型，具体为：
[0007] 首先建立机器人及机器人吸盘，锻压机的数学模型；将机器人杆件简化为长方体， 每个长方体都包围一个对应的杆件，长方体上八个顶点相对杆件自身坐标系建立；
[0008] 假设机器人各杆件包围盒各点在对应杆件坐标系下齐次坐标为：
[0009] pa(i,j) =[Xij, Yij, Zij,1]T
[0010] 其中pa(I，j)为对应杆件i包围盒位置向量，i为杆件序号，j为包围盒上顶点序 号，则各杆件顶点位置可通过机器人正运动学计算得到，即
[0011] pb(i，j) =0TiPa(i，j)
[0012] 其中pb(i，j)为包围盒各顶点在机器人基坐标系下的坐标；
[0013] 步骤102、将上述机器人关节轴包络模型和锻压机简化包络模型分别向三个坐标 面平面进行投影；
[0014] 步骤103、判定机器人是否发生碰撞，具体为：
[0015] 如果任意一个投影不存在重叠区域，则判定机器人不发生碰撞；如果有一个投影 存在重叠区域，则表示可能有碰撞，随后；如果另外两个投影面中投影不存在重叠区域，则 判定机器人不发生碰撞；如果另外两个投影面任意一个存在重叠区域，则表示可能有碰 撞；
[0016] 步骤104、当判定结果为机器人发生碰撞时，则需要更改路径。
[0017] 进一步：所述机器人为ABBIRB6640机器人，该机器人由可回转的基座、大臂、小 臂、腕关节组成，该机器人是由六个转动关节相连接的开链连杆式关节型机器人，在每个关 节上建立一个坐标系，利用坐标系之间的关系来描述末端执行器的状态；通过分析机器人 的结构特点，采用D-H坐标法建立机器人坐标系模型；D-H坐标法（四参数法）是采用齐次 变换矩阵来描述相邻两连杆之间的关系，最终得到首、末端连杆坐标系之间的变换矩阵，从 而建立机器人的运动方程。
[0018] 本发明具有的优点和积极效果是：本发明采用AABB包络模型分析了机器人关节 轴模型和液压件简化模型，并在此基础上进行了机器人碰撞检测算法研宄，提高了碰撞检 测效率。
【附图说明】
[0019] 图1是本发明中机器人杆件的包络模型；
[0020] 图2是本发明中锻压机包络模型；
[0021] 图3是本发明中转动后包围盒空间；
[0022] 图4是本发明中AABB包围盒投影范围示意图；
[0023] 图5是本发明中碰撞检测投影示意图；
[0024] 图6是本发明中碰撞检测结果。
【具体实施方式】
[0025] 为能进一步了解本发明的
【发明内容】
、特点及功效，兹例举以下实施例，并配合附图 详细说明如下：
[0026] 一种冲压线搬运机器人防碰撞控制方法，包括如下步骤：
[0027] 首先建立机器人及末端执行工具（即机器人吸盘），锻压机的数学模型。以ABB机 器人的第三到六杆件为例，将机器人杆件简化为长方体，每个长方体都包围一个对应的杆 件，长方体上8个顶点相对杆件自身坐标系建立，如图1所示。
[0028] 假设机器人各杆件包围盒各点在对应杆件坐标系下齐次坐标为：
[0029]pa(i,j) =[Xij, Yij, Zij,1]T (式 1)
[0030] 其中pa(I，j)为对应杆件i包围盒位置向量，i为杆件序号，j为包围盒上顶点序 号，则各杆件顶点位置可通过机器人正运动学计算得到，即
[0031] pb(i,j) =°TiPa(i,j) (式 2)
[0032] 式2中pb(i，j)为包围盒各顶点在机器人基坐标系下的坐标。
[0033] 本优选实施例中的机器人为：ABBIRB6640机器人，它由可回转的基座、大臂、小 臂、腕关节等组成，它是由六个转动关节相连接的开链连杆式关节型机器人，为了清晰描述 末端工具在空间中的位置和姿态，可在各个关节上建立一个坐标系，利用坐标系之间的关 系来描述末端执行器的状态。通过分析机器人的结构特点，采用D-H坐标法建立机器人坐 标系模型。D-H坐标法（四参数法）是采用齐次变换矩阵来描述相邻两连杆之间的关系，最 终得到首、末端连杆坐标系之间的变换矩阵，从而建立机器人的运动方程。
[0034] ABBIRB6640机器人的D-H数学模型如下：
[0035] 表1机器人DH模型
【主权项】
1. 一种冲压线搬运机器人防碰撞控制方法，其特征在于：包括如下步骤： 步骤101、基于AABB包围盒法建立机器人关节轴包络模型和锻压机简化包络模型，具 体为： 首先建立机器人及机器人吸盘，锻压机的数学模型；将机器人杆件简化为长方体，每个 长方体都包围一个对应的杆件，长方体上八个顶点相对杆件自身坐标系建立； 假设机器人各杆件包围盒各点在对应杆件坐标系下齐次坐标为： Pa (i) J)一[xij> Yij) zij)1] 其中Pa(I，j)为对应杆件i包围盒位置向量，i为杆件序号，j为包围盒上顶点序号，则 各杆件顶点位置可通过机器人正运动学计算得到，即 Pb(i, J') = 0TiPa (i, j) 其中Pb(i，j)为包围盒各顶点在机器人基坐标系下的坐标； 步骤102、将上述机器人关节轴包络模型和锻压机简化包络模型分别向三个坐标面平 面进行投影； 步骤103、判定机器人是否发生碰撞，具体为： 如果任意一个投影不存在重叠区域，则判定机器人不发生碰撞；如果有一个投影存在 重叠区域，则表示可能有碰撞，随后；如果另外两个投影面中投影不存在重叠区域，则判定 机器人不发生碰撞；如果另外两个投影面任意一个存在重叠区域，则表示可能有碰撞； 步骤104、当判定结果为机器人发生碰撞时，则需要更改路径。
2. 根据权利要求1所述的冲压线搬运机器人防碰撞控制方法，其特征在于：所述机器 人为ABB IRB6640机器人，该机器人由可回转的基座、大臂、小臂、腕关节组成，该机器人 是由六个转动关节相连接的开链连杆式关节型机器人，在每个关节上建立一个坐标系，利 用坐标系之间的关系来描述末端执行器的状态；通过分析机器人的结构特点，采用D-H坐 标法建立机器人坐标系模型；D-H坐标法是采用齐次变换矩阵来描述相邻两连杆之间的关 系，最终得到首、末端连杆坐标系之间的变换矩阵，从而建立机器人的运动方程。
【专利摘要】本发明公开了一种冲压线搬运机器人防碰撞控制方法，包括如下步骤：步骤101、基于AABB包围盒法建立机器人关节轴包络模型和锻压机简化包络模型；步骤102、将上述机器人关节轴包络模型和锻压机简化包络模型分别向三个坐标面平面进行投影；步骤103、判定机器人是否发生碰撞，具体为：如果任意一个投影不存在重叠区域，则判定机器人不发生碰撞；如果有一个投影存在重叠区域，则表示可能有碰撞，随后结合其余两个投影面进一步判断。本发明采用AABB包络模型分析了机器人关节轴模型和液压件简化模型，并在此基础上进行了机器人碰撞检测算法研究，提高了碰撞检测效率。
【IPC分类】G06F17-50, G06T17-00
【公开号】CN104850699
【申请号】CN201510257561
【发明人】周丽霞
【申请人】天津市天锻压力机有限公司
【公开日】2015年8月19日
【申请日】2015年5月19日