CN107336230B - 一种基于投影和距离判断的工业机器人碰撞预测方法 - Google Patents
一种基于投影和距离判断的工业机器人碰撞预测方法 Download PDFInfo
- Publication number
- CN107336230B CN107336230B CN201710321118.8A CN201710321118A CN107336230B CN 107336230 B CN107336230 B CN 107336230B CN 201710321118 A CN201710321118 A CN 201710321118A CN 107336230 B CN107336230 B CN 107336230B
- Authority
- CN
- China
- Prior art keywords
- joint
- distance
- projection
- collision
- safe
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 35
- 238000001514 detection method Methods 0.000 claims description 12
- 238000006073 displacement reaction Methods 0.000 claims description 3
- 238000004519 manufacturing process Methods 0.000 description 5
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1674—Programme controls characterised by safety, monitoring, diagnostic
- B25J9/1676—Avoiding collision or forbidden zones
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39083—Robot interference, between two robot arms
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
一种基于投影和距离判断的工业机器人碰撞预测方法,对于运行过程中可能发的碰撞,采用一种检测关节投影干涉情况然后判断关键点距离的方法进行碰撞检测:将机器人关节向速度向量的法平面投影,若关节投影发生干涉则对关节轴线上各关键点最短距离进行判断,若小于运行时的安全距离则认为存在碰撞的风险。本发明提供了一种控制精度较高、有效实现避障、安全性较高的基于投影和距离判断的工业机器人碰撞预测方法。
Description
技术领域
本发明涉及一种工业机器人碰撞预测方法,尤其是一种两个工业机器人在同一工作空间运动时的碰撞预测方法。
背景技术
近十几年工业机器人的制造和控制技术发展迅速,已经广泛地应用于汽车制造业并能达到很高的控制精度。随着我国劳动力成本增加,在“机器换人”和产业升级的要求下各行业的自动化生产水平亟需提高。应用工业机器人能够避免重复繁琐的人工劳动、实现高稳定、高精度生产,从而使工作效率得到很大提升。对单个机器人的路径、轨迹规划大多能通过人工示教完成,所以已经有越来越多的工厂使用可编程的工业机器人代替生产线上的人工。但是对于一类需要两个机器人互相协调配合才能完成的任务,如何让机器人既能够自主避免可能出现的干涉和碰撞又能快速准确地完成任务,这便要求机器人在协作运动的同时能够对可能出现的碰撞作出可靠的预测。
发明内容
为了克服已有工业机器人轨迹规划方法中无法有效预测碰撞、安全性较低的不足,本发明提供了一种控制精度较高、有效实现碰撞预测、安全性较高的基于投影和距离判断的工业机器人碰撞预测方法。
本发明解决其技术问题所采用的技术方案是:
一种基于投影和距离判断的工业机器人碰撞预测方法,对于运行过程中可能发的碰撞,采用一种检测关节投影干涉情况然后判断关键点距离的方法进行碰撞检测:将机器人关节向速度向量的法平面投影,若关节投影发生干涉则对关节轴线上各关键点最短距离进行判断,若小于运行时的安全距离则认为存在碰撞的风险。
进一步,所述碰撞预测方法包括以下步骤:
步骤1:机器人关节标准化处理
对于两个机器人同时作业,按照关节几何形状,采用半球端面圆柱体包络两个关节从而得到标准化后的关节边界。
步骤2:求解运动过程中的安全距离
根据dhit设定碰撞检测的极限距离dlim=k1*dhit以及安全距离dsafe=k2*dhit,k1,k2为安全系数;
步骤3:碰撞预测
则说明两个关节在速度向量法平面的投影发生干涉,则进一步判断各关节关键点之间最短距离d,若有:
d=min{‖P11-P21‖,‖P11-P22‖,‖P11-P23‖…‖P11-P24‖}<dsafe
则判定为有可能碰撞的危险状态,否则认为是安全运行。
本发明的技术构思为:通过判断关节在运动方向向量法平面上投影的干涉情况以及关节上所选点的距离完成碰撞检测。
本发明的有益效果主要表现在:提出了一种检测关节投影干涉情况然后判断关键点距离的方法进行碰撞检测,相较于单纯的最短距离检测能够更有效地完成机器人关节运动过程的碰撞检测;
附图说明
图1为碰撞检测流程图。
具体实施方式
下面结合附图对本发明作进一步描述。
参照图1,一种基于投影和距离判断的工业机器人碰撞预测方法,对于运行过程中可能发的碰撞,采用一种检测关节投影干涉情况然后判断关键点距离的方法进行碰撞检测:将机器人关节向速度向量的法平面投影,若关节投影发生干涉则对关节轴线上各关键点最短距离进行判断,若小于运行时的安全距离则认为存在碰撞的风险。
所述工业机器人碰撞预测方法的过程为:首先,对机器人关节进行标准化处理,然后检测关节投影干涉情况通过判断关键点距离进行碰撞检测:将机器人关节向速度向量的法平面投影,若关节投影发生干涉则对关节轴线上各关键点最短距离进行判断,若小于运行时的安全距离则认为存在碰撞的风险。
对于两个机器人同时作业,其各关节为复杂的圆周运动,在这样的运动状态下单纯的根据关节间距离并不能准确地预判碰撞的发生。本发明采用一种先检测关节投影干涉情况然后判断关键点之间最短距离的方法完成完成运动过程中的碰撞检测。以两个机器人末端关节为例进行说明:
所述碰撞预测方法包括以下步骤:
步骤1:机器人关节标准化处理
按照关节几何形状,采用半球端面圆柱体包络两个关节从而得到标准化后的关节边界。
步骤2:关键点选取以及碰撞预测安全距离计算
由步骤2标准化处理后,连接两球面端点连线即得到关节轴线,长度为li(i=1,2);对于圆柱体半径为ri。在各轴线按等间距取个点作为计算关节距离的关键点记为根据关节轴线上所取关键点可得两关节碰撞时的临界距离:
根据dhit设定碰撞检测的极限距离dlim=k1*dhit以及安全距离dsafe=k2*dhit,k1,k2为安全系数可根据实际选取大于1的常数。
步骤3:碰撞预测
处于运动状态的工业机器人,根据其关节角位移以及瞬时角速度可由正运动学求解得各关键点的笛卡尔坐标以及关节末端速度向量VF。将步骤2中得到的关键点投影到VF向量的法平面得到关键点的投影点判断各投影点之间的最小距离d′若:
则说明两个关节在速度向量法平面的投影发生干涉,则进一步判断各关节关键点之间最短距离d,若有:
d=min{‖P11-P21‖,‖P11-P22‖,‖P11-P23‖…‖P11-P24‖}<dsafe
则判定为有可能碰撞的危险状态否则认为是安全运行。
Claims (1)
1.一种基于投影和距离判断的工业机器人碰撞预测方法,其特征在于:
对于运行过程中可能发的碰撞,采用一种检测关节投影干涉情况然后判断关键点距离的方法进行碰撞检测:将机器人关节向速度向量的法平面投影,若关节投影发生干涉则对关节轴线上各关键点最短距离进行判断,若小于运行时的安全距离则认为存在碰撞的风险;所述碰撞预测方法包括以下步骤:
步骤1:机器人关节标准化处理
对于两个机器人同时作业,按照关节几何形状,采用半球端面圆柱体包络两个关节从而得到标准化后的关节边界;
步骤2:求解运动过程中的安全距离
根据dhit设定碰撞检测的极限距离dlim=k1*dhit以及安全距离dsafe=k2*dhit,k1,k2为安全系数;
步骤3:碰撞预测
则说明两个关节在速度向量法平面的投影发生干涉,则进一步判断各关节关键点之间最短距离d,若有:
d=min{||P11-P21||,||P11-P22||,||P11-P23||...||P11-P24||}<dsafe
则判定为有可能碰撞的危险状态,否则认为是安全运行。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710321118.8A CN107336230B (zh) | 2017-05-09 | 2017-05-09 | 一种基于投影和距离判断的工业机器人碰撞预测方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710321118.8A CN107336230B (zh) | 2017-05-09 | 2017-05-09 | 一种基于投影和距离判断的工业机器人碰撞预测方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107336230A CN107336230A (zh) | 2017-11-10 |
CN107336230B true CN107336230B (zh) | 2020-05-05 |
Family
ID=60220239
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710321118.8A Active CN107336230B (zh) | 2017-05-09 | 2017-05-09 | 一种基于投影和距离判断的工业机器人碰撞预测方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107336230B (zh) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108326859A (zh) * | 2018-05-07 | 2018-07-27 | 广东工业大学 | 一种有效避免机械臂在工作过程中发生干涉的方法 |
CN108873899B (zh) * | 2018-06-27 | 2022-03-25 | 杨扬 | 吸尘机器人的避障方法 |
CN109353338B (zh) * | 2018-08-10 | 2022-02-15 | 重庆大数据研究院有限公司 | 一种智能车超车道碰撞概率安全预测方法 |
CN110308667B (zh) * | 2019-05-16 | 2022-07-26 | 广州明珞汽车装备有限公司 | 一种自动设置干涉检查的方法、系统、装置和存储介质 |
CN110253570B (zh) * | 2019-05-27 | 2020-10-27 | 浙江工业大学 | 基于视觉的工业机械臂人机安全系统 |
CN111203916B (zh) * | 2020-01-16 | 2021-06-08 | 山西万合智能科技有限公司 | 一种机器人关节与几何体碰撞的检测方法 |
CN111168683B (zh) * | 2020-01-20 | 2022-08-02 | 吉利汽车研究院(宁波)有限公司 | 一种机器人路径干涉检测方法、装置、介质及设备 |
CN114021850B (zh) * | 2020-11-26 | 2024-04-16 | 广东博智林机器人有限公司 | 建筑作业设备的碰撞预测方法、装置及建筑作业设备 |
TWI845798B (zh) * | 2020-12-28 | 2024-06-21 | 財團法人工業技術研究院 | 協作機械手臂系統及其復位方法 |
CN113664874A (zh) * | 2021-08-30 | 2021-11-19 | 湖南工业大学 | 一种移动机器人多臂的干涉检测方法 |
CN113469472B (zh) * | 2021-09-06 | 2022-02-22 | 中导光电设备股份有限公司 | 一种多显微镜定点拍照路径优化方法 |
CN113910300B (zh) * | 2021-10-25 | 2023-05-23 | 苏州灵猴机器人有限公司 | 一种机器人末端防撞方法 |
CN115933557A (zh) * | 2022-12-07 | 2023-04-07 | 厦门客来点信息科技有限公司 | Agv调度方法、系统、终端及存储介质 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
ATE412929T1 (de) * | 2006-09-14 | 2008-11-15 | Abb Research Ltd | Verfahren und vorrichtung zur vermeidung von kollisionen zwischen einem industrieroboter und einem objekt |
JP4844453B2 (ja) * | 2007-04-09 | 2011-12-28 | 株式会社デンソーウェーブ | ロボットの教示装置及び教示方法 |
CN104156520B (zh) * | 2014-07-31 | 2017-04-12 | 哈尔滨工程大学 | 一种基于直线投影的凸多面体碰撞检测方法 |
CN104985598B (zh) * | 2015-06-24 | 2016-11-23 | 南京埃斯顿机器人工程有限公司 | 一种工业机器人碰撞检测方法 |
CN105700527A (zh) * | 2016-01-26 | 2016-06-22 | 哈尔滨工业大学 | 一种平面冗余度机器人避障及避奇异的路径规划方法 |
CN106182019B (zh) * | 2016-07-29 | 2017-05-17 | 中国科学技术大学 | 工业机器人抓取过程的动态避障系统及其方法 |
-
2017
- 2017-05-09 CN CN201710321118.8A patent/CN107336230B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN107336230A (zh) | 2017-11-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107336230B (zh) | 一种基于投影和距离判断的工业机器人碰撞预测方法 | |
CN107116540B (zh) | 一种基于scs包围结构的机器人碰撞检测方法 | |
CN108908331B (zh) | 超冗余柔性机器人的避障方法及系统、计算机存储介质 | |
CN106391366B (zh) | 一种民用飞机大部件自动化涂装系统 | |
Gong et al. | Analytical inverse kinematics and self-motion application for 7-DOF redundant manipulator | |
CN104331542B (zh) | 一种大型自由曲面的喷涂机器人站位规划方法 | |
Božek | Robot path optimization for spot welding applications in automotive industry | |
CN105773609A (zh) | 一种基于视觉测量及距离误差模型的机器人运动学标定方法 | |
CN109876968B (zh) | 一种钢结构机器人喷涂自动路径规划方法 | |
CN104827479A (zh) | 一种面向激光加工机器人的管道插接相贯线轨迹规划方法 | |
CN104385283B (zh) | 一种六自由度机械臂奇异位形的快速判断方法 | |
CN107791248B (zh) | 基于不满足Pieper准则的六自由度串联机器人的控制方法 | |
CN112757057A (zh) | 融合视觉深度分析的智能免人工示教打磨抛光方法及系统 | |
CN108481324B (zh) | 一种八轴多功能机械臂的逆解工程及其碰撞检测算法 | |
CN108469785B (zh) | 一种基于隐函数的五轴加工复杂曲面碰撞检测方法 | |
CN106272429B (zh) | 一种龙门式吊装机器人工作单元中附加轴运动规划方法 | |
CN112405541A (zh) | 激光3d精密切割双机器人协同作业方法 | |
Glogowski et al. | Extended calculation of the dynamic separation distance for robot speed adaption in the human-robot interaction | |
CN113696187B (zh) | 一种适用于双机器人系统的防碰撞方法 | |
CN107717988A (zh) | 一种基于泛克里金的工业机械臂精度标定方法 | |
CN105234930A (zh) | 基于构形平面的冗余机械臂运动控制方法 | |
CN111428334A (zh) | 激光雷达测量中机器人站位规划方法 | |
CN109648563B (zh) | 串联机器人运动控制方法及计算机存储介质 | |
CN106271235B (zh) | 基于机器视觉的焊道定位方法及装置 | |
CN105904458A (zh) | 一种基于复杂操作任务的非完整遥操作约束控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |