CN113985807A - 一种激光熔覆熔覆头防撞避障控制***及方法 - Google Patents
一种激光熔覆熔覆头防撞避障控制***及方法 Download PDFInfo
- Publication number
- CN113985807A CN113985807A CN202111038538.8A CN202111038538A CN113985807A CN 113985807 A CN113985807 A CN 113985807A CN 202111038538 A CN202111038538 A CN 202111038538A CN 113985807 A CN113985807 A CN 113985807A
- Authority
- CN
- China
- Prior art keywords
- cladding head
- unit
- clamp
- workpiece
- information
- 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.)
- Granted
Links
- 238000004372 laser cladding Methods 0.000 title claims abstract description 45
- 238000000034 method Methods 0.000 title claims abstract description 37
- 238000005253 cladding Methods 0.000 claims abstract description 116
- 238000001514 detection method Methods 0.000 claims abstract description 26
- 238000004519 manufacturing process Methods 0.000 claims abstract description 13
- 238000012545 processing Methods 0.000 claims abstract description 11
- 238000005259 measurement Methods 0.000 claims abstract description 9
- 238000004458 analytical method Methods 0.000 claims abstract description 5
- 238000004422 calculation algorithm Methods 0.000 claims description 20
- 230000008569 process Effects 0.000 claims description 13
- 230000004886 head movement Effects 0.000 claims description 5
- 239000007787 solid Substances 0.000 claims description 2
- 230000004888 barrier function Effects 0.000 claims 2
- 239000000155 melt Substances 0.000 claims 2
- 238000010586 diagram Methods 0.000 description 8
- 230000007547 defect Effects 0.000 description 4
- 230000008901 benefit Effects 0.000 description 3
- 230000006872 improvement Effects 0.000 description 3
- 238000009434 installation Methods 0.000 description 3
- 238000012544 monitoring process Methods 0.000 description 3
- 238000011160 research Methods 0.000 description 3
- 238000003491 array Methods 0.000 description 2
- 238000004590 computer program Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000008092 positive effect Effects 0.000 description 2
- 230000002265 prevention Effects 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 239000011324 bead Substances 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000001788 irregular Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000036632 reaction speed Effects 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 238000003860 storage Methods 0.000 description 1
Images
Classifications
-
- 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
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/19—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
-
- C—CHEMISTRY; METALLURGY
- C23—COATING METALLIC MATERIAL; COATING MATERIAL WITH METALLIC MATERIAL; CHEMICAL SURFACE TREATMENT; DIFFUSION TREATMENT OF METALLIC MATERIAL; COATING BY VACUUM EVAPORATION, BY SPUTTERING, BY ION IMPLANTATION OR BY CHEMICAL VAPOUR DEPOSITION, IN GENERAL; INHIBITING CORROSION OF METALLIC MATERIAL OR INCRUSTATION IN GENERAL
- C23C—COATING METALLIC MATERIAL; COATING MATERIAL WITH METALLIC MATERIAL; SURFACE TREATMENT OF METALLIC MATERIAL BY DIFFUSION INTO THE SURFACE, BY CHEMICAL CONVERSION OR SUBSTITUTION; COATING BY VACUUM EVAPORATION, BY SPUTTERING, BY ION IMPLANTATION OR BY CHEMICAL VAPOUR DEPOSITION, IN GENERAL
- C23C24/00—Coating starting from inorganic powder
- C23C24/08—Coating starting from inorganic powder by application of heat or pressure and heat
- C23C24/10—Coating starting from inorganic powder by application of heat or pressure and heat with intermediate formation of a liquid phase in the layer
-
- 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/35—Nc in input of data, input till input file format
- G05B2219/35349—Display part, programmed locus and tool path, traject, dynamic locus
Landscapes
- Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Organic Chemistry (AREA)
- Materials Engineering (AREA)
- Mechanical Engineering (AREA)
- Metallurgy (AREA)
- Chemical Kinetics & Catalysis (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Laser Beam Processing (AREA)
Abstract
本发明属于激光熔覆控制技术领域,公开了一种激光熔覆熔覆头防撞避障装置和控制***及方法,激光熔覆熔覆头防撞避障控制***包括:超声测距模块、控制模块以及执行模块;超声测距模块利用可调整位置的超声测距传感器进行超声测距;控制模块包括碰撞检测单元、位置识别单元、位置判断单元、避障路径规划单元、运动控制单元;用于进行数据处理、分析、位置识别、避障路径规划并生产控制指令;执行模块,包括机械臂和夹具;用于接收并执行控制指令。本发明对熔覆头在行进方向上进行了饱和测量,提升了熔覆头的安全系数;实现了熔覆头的自动避障,提高了生产效率。
Description
技术领域
本发明属于激光熔覆控制技术领域,尤其涉及一种激光熔覆熔覆头防撞避障控制***及方法。
背景技术
目前,激光熔覆技术,是一种新的表面改性技术。针对多区域修复件的激光熔覆过程,工件需要通过夹具运动进行位置调整,同时熔覆头也需要在多个熔覆区间内进行空行程的移动,由于在规划熔覆路径的时候对熔覆头尺寸、工件结构等因素考虑不够,以及路径规划算法存在的缺陷导致预设的运动路径不合理,容易使激光熔覆头与工件发生碰撞,不仅会影响熔覆头的熔覆精度,严重的可能还会造成熔覆头损坏,导致生产效率降低,对企业带来较大的经济损失。预防和解决熔覆过程中可能发生的碰撞问题,不仅能保护熔覆头不受损失,同时对企业经济效益的提高具有积极效应。
激光熔覆熔覆头防撞避障控制一直是行业里研究的热点。传统的熔覆头防碰撞装置主要研究集中在被动式防撞装置方面,即在激光熔覆头与工件发生了碰撞后才进行制动,由于运动惯性的缘故,装置作出反应具有一定的迟滞性,难以保障不给熔覆头带来负面影响;而在主动式防碰撞方面,相关专利通过利用传感器对熔覆头与障碍物之间的距离进行实时测量,随后根据与设定的安全阈值的比较结果控制熔覆头的运动状态,从而达到防碰撞的效果,但这类专利中传感器存在较大的监测盲区,无法保证对熔覆头前进方向上的饱和测量。同时,目前针对熔覆头避障的研究主要集中在熔覆前的路径规划方面,而对于熔覆过程中的实时避障研究较少,所以传统方法在检测到可能发生碰撞的结果后,熔覆过程将自动停止等待人工介入进行干预,缺少在检测出碰撞后自动避障的操作,不利于生产效率的提高。
通过上述分析,现有技术存在的问题及缺陷为:现有激光熔覆熔覆头防撞装置具备一定迟滞性,传感器存在较大的监测盲区,无法保证对熔覆头前进方向上的饱和测量;且在检测到可能发生碰撞的结果后,熔覆过程将自动停止等待人工介入进行干预,缺少检测出障碍后自动避障的操作,不利于生产效率的提高。
解决以上问题及缺陷的难度为:在较低的数据处理量下实现熔覆头行进方向上的饱和测量;检测出碰撞后夹具及机械臂的自动避障运动策略及路径规划。
解决以上问题及缺陷的意义为:对熔覆头行进方向进行饱和测量,提升了熔覆头安全系数,避免不必要的财产损失,同时单一传感器的使用降低了数据处理难度,提升了响应速度;在无需进行新的路径规划的情况下实现熔覆头的自动避障,减少人工干预和停车等待时间,提高了生产效率,降低了人工成本。
发明内容
针对现有技术存在的问题,本发明提供了一种激光熔覆熔覆头防撞避障控制***及方法。
本发明是这样实现的,一种激光熔覆熔覆头防撞避障控制***,所述激光熔覆熔覆头防撞避障控制***包括:
超声测距模块、控制模块以及执行模块;
超声测距模块,包括超声测距传感器和环状随动装置;用于利用可调整位置的超声测距传感器进行超声测距;
控制模块,包括碰撞检测单元、位置识别单元、位置判断单元、避障路径规划单元、运动控制单元;用于进行数据处理、分析、位置识别、避障路径规划并生产控制指令;
执行模块,包括机械臂和夹具;用于接收并执行控制指令。
进一步,所述超声测距模块包括:
所述超声测距模块,包括超声测距传感器和环状随动装置,所述超声测距传感器和环状随动装置固定于熔覆头上;
所述环状随动装置用于根据熔覆头行进方向对超声测距传感器位置进行实时调整,令测量方向与行进方向的一致。
进一步,所述控制模块包括:
碰撞检测单元,用于接收超声测距模块反馈的信息并进行判断,同时将结果输出至运动控制单元;
位置识别单元,用于根据先前输入的路径信息及工件三维模型对熔覆头、夹具当前前位置及目标位置进行确认,并自动生成安全高度和中间点,将结果输入位置判断单元、避障路径规划单元和运动控制单元;
位置判断单元,用于通过对比当前的位置信息和目标位置信息,判断夹具或熔覆头是否还需运动;
避障路径规划单元,用于在获取到熔覆头与目标点的位置后,结合工件的三维模型建立环境模型,利用避障路径生产算法生成实时避障路径,并将路径信息输出至运动控制单元;
运动控制单元,用于接收来自位置识别单元、碰撞检测单元、位置判断单元、避障路径规划单元的信息,对接收信息进行处理,同时基于处理后的信息生成控制指令。
进一步,所述路径信息包括夹具的运动路径和熔覆头移动路径。
进一步,所述执行模块包括:
机械臂,用于控制熔覆头的运动;
夹具,用于调整被熔覆物体的位置。
本发明的另一目的在于提供一种应用于所述激光熔覆熔覆头防撞避障控制***的激光熔覆熔覆头防撞避障控制方法,所述激光熔覆熔覆头防撞避障控制方法包括:
步骤一,超声测距模块根据输入的熔覆头移动路径信息实时调整超声测距传感器的探测方向,并将获得的信息反馈至碰撞检测单元,并记录此时探测的距离i;
步骤二,碰撞检测单元将超声测距模块获取到的距离信息i与预先设定的安全阈值j进行比较,当i>j时,运动控制单元控制执行模块继续进行下一步熔覆处理;当i≦j时,将结果输出至运动控制单元,运动控制单元对执行模块发出停止指令,并转向步骤三;
步骤三,执行模块接收停止指令后,位置识别单元根据预先输入的熔覆头移动路径信息和夹具运动路径信息确认熔覆头及夹具当前位置和目标位置;
步骤四,运动判断单元在获得当前夹具旋转角θ1后,与下一熔覆操作夹具目标旋转角θ2进行对比,并将结果输出至运动控制单元;当θ1=θ2时,转向步骤六;θ1≠θ2时,转向步骤五;
步骤五,位置识别单元根据路径信息以及工件三维模型对当前工件及夹具位置姿态进行识别,同时遍历夹具转动过程中夹具及工件的轨迹点,对工件外形轮廓进行一定的偏置,并自动生成安全高度和中间点位置;
步骤六,运动控制单元对执行模块输出对机械臂Z轴方向上的驱动指令,提升熔覆头到安全高度h,再控制机械臂使熔覆头移动到中间点位置;
步骤七,熔覆头移动到中间点后,运动控制单元根据位置判断单元输入的信息对执行模块输出对夹具的驱动指令,控制夹具运动到目标位置;
步骤八,避障路径规划单元结合工件三维实体模型进行环境地图划分,再根据位置识别单元输入的熔覆头目标点位置,以中间点位置为起始点,利用路径规划算法生成到目标点的路径,输出至运动控制单元;
步骤九,运动控制单元按避障路径规划单元生成的路径信息输出对运动单元机械臂的控制指令,控制熔覆头到达目标点位置;继续按照之前的路径信息执行下一步熔覆处理。
进一步,所述步骤一之前还需进行:在设置有超声测距模块的熔覆头上最大半径值的基础上,进行一定的安全补偿,并设定安全阈值j、偏置值。
进一步,所述安全高度和中间点生成包括:
所述安全高度的生成包括:位置判断模块对工件及夹具位置姿态识别后,获取其在Z轴方向上的最大高度值,并进行一定的安全补偿,得到安全高度;
所述中间点的生成包括:模拟夹具下一步运动,得到夹具及工件的运动轨迹;结合工件的三维模型对工件的外形轮廓进行偏置;选择改进欧式距离最短的点作为中间点,改进欧式距离公式如下:
其中,K为常数,当选择点与目标点之间存在障碍物时,K=1000;不存在障碍物时,K=0。
进一步,所述环境地图可利用直接表示法、特征地图、拓扑地图和栅格地图的形式进行表示。
进一步,所述路径规划模块包括A*算法、Dijkstra算法、RRT算法。
本发明的另一目的在于提供一种计算机可读存储介质,存储有计算机程序,所述计算机程序被处理器执行时,使得所述处理器执行所述激光熔覆熔覆头防撞避障控制方法。
本发明的另一目的在于提供一种熔覆头防碰撞装置,所述熔覆头防碰撞装置搭载所述激光熔覆熔覆头防撞避障控制***。
结合上述的所有技术方案,本发明所具备的优点及积极效果为:本发明提出了一种新颖的能够满足熔覆头前进方向上饱和测量的主动式防碰撞装置和自动避障的控制***和方法,能够解决熔覆过程中熔覆头的防撞避障问题。
本发明超声波测距传感器能够根据熔覆头的前进方向实时调整测量方向,减少了超声波测距传感器在熔覆头前进方向上的监测盲区,且只使用一个超声波测距传感器,使其具有较低的数据处理难度及较快的反应速度。
本发明在检测到可能发生碰撞的结果后,自动指引夹具及熔覆头运动到下一熔覆阶段的初始位置,继续按照先前规划好的路径进行下一步操作,无需进行新的路径规划和人工干预,减少了停机等待时间,提高了生产效率。
附图说明
图1为本发明的激光熔覆熔覆头防碰撞装置示意图。
图2为本发明的激光熔覆熔覆头防撞避障控制***工作示意图。
图3是本发明提供的激光熔覆熔覆头防撞避障的控制***工作流程图
图4为本发明的激光熔覆熔覆头防撞避障***原理图。
图5是本发明实施例提供的工件三视图。
图6是本发明实施例提供的熔覆头预碰撞示意图。
图7是本发明实施例提供的工件运动轨迹模拟示意图。
图8是本发明实施例提供的工件的外形轮廓偏置示意图。
图9是本发明实施例提供的目标点选择示意图。
图1-图2中:1、熔覆头;2、超声测距模块;3、内圈环形齿轮;4、带有传感器和电机安装孔的外套;5、超声测距传感器;6、传感器紧固螺丝;7、随动装置电机;8、紧固装置;9、紧固螺丝;10、机械臂;11、夹具;12、控制模块。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
针对现有技术存在的问题,本发明提供了一种激光熔覆熔覆头防撞避障控制***及方法,下面结合附图对本发明作详细的描述。
如图1-图2所示,本发明实施例提供的激光熔覆熔覆头防撞避障控制***包括:
超声测距模块2、控制模块12以及执行模块;
超声测距模块2,包括超声测距传感器5和环状随动装置;用于利用可调整位置的超声测距传感器进行超声测距;
控制模块12,包括碰撞检测单元、位置识别单元、位置判断单元、避障路径规划单元、运动控制单元;用于进行数据处理、分析、位置识别、避障路径规划并生产控制指令;
执行模块,包括机械臂10和夹具11;用于接收并执行控制指令。
本发明实施例提供的超声测距模块2包括:
超声测距模块,包括超声测距传感器和环状随动装置,所述超声测距传感器和环状随动装置固定于熔覆头上;
环状随动装置用于根据熔覆头行进方向对超声测距传感器位置进行实时调整,令测量方向与行进方向的一致。
本发明实施例提供的控制模块包括:
碰撞检测单元,用于接收超声测距模块反馈的信息并进行判断,同时将结果输出至运动控制单元;
位置识别单元,用于根据先前输入的路径信息及工件三维模型对熔覆头、夹具当前前位置及目标位置进行确认,并自动生成安全高度和中间点,将结果输入位置判断单元、避障路径规划单元和运动控制单元;
位置判断单元,用于通过对比当前的位置信息和目标位置信息,判断夹具或熔覆头是否还需运动;
避障路径规划单元,用于在获取到熔覆头与目标点的位置后,结合工件的三维模型建立环境模型,利用避障路径生产算法生成实时避障路径,并将路径信息输出至运动控制单元;
运动控制单元,用于接收来自位置识别单元、碰撞检测单元、位置判断单元、避障路径规划单元的信息,对接收信息进行处理,同时基于处理后的信息生成控制指令。
本发明实施例提供的路径信息包括夹具的运动路径和熔覆头移动路径。
本发明实施例提供的执行模块包括:
机械臂,用于控制熔覆头的运动;
夹具,用于调整被熔覆物体的位置。
如图3所示,本发明实施例提供的激光熔覆熔覆头防撞避障控制方法包括:
S101,超声测距模块根据输入的熔覆头移动路径信息实时调整超声测距传感器的探测方向,并将获得的信息反馈至碰撞检测单元,并记录此时探测的距离i;
S102,碰撞检测单元将超声测距模块获取到的距离信息i与预先设定的安全阈值j进行比较,当i>j时,运动控制单元控制执行模块继续进行下一步熔覆处理;当i≦j时,将结果输出至运动控制单元,运动控制单元对执行模块发出停止指令,并转向步骤S103;
S103,执行模块接收停止指令后,位置识别单元根据预先输入的熔覆头移动路径信息和夹具运动路径信息确认熔覆头及夹具当前位置和目标位置;
S104,运动判断单元在获得当前夹具旋转角θ1后,与下一熔覆操作夹具目标旋转角θ2进行对比,并将结果输出至运动控制单元;当θ1=θ2时,转向步骤S106;θ1≠θ2时,转向步骤S105;
S105,位置识别单元根据路径信息以及工件三维模型对当前工件及夹具位置姿态进行识别,同时遍历夹具转动过程中夹具及工件的轨迹点,对工件外形轮廓进行一定的偏置,并自动生成安全高度和中间点位置;
S106,运动控制单元对执行模块输出对机械臂Z轴方向上的驱动指令,提升熔覆头到安全高度h,再控制机械臂使熔覆头移动到中间点位置;
S107,熔覆头移动到中间点后,运动控制单元根据位置判断单元输入的信息对运动单元输出对夹具的驱动指令,控制夹具运动到目标位置;
S108,避障路径规划单元结合工件三维实体模型进行环境地图划分,再根据位置识别单元输入的熔覆头目标点位置,以中间点位置为起始点,利用的路径规划算法生成到目标点的路径,输出至运动控制单元;
S109,运动控制单元按避障路径规划单元生成的路径信息输出对运动单元机械臂的控制指令,控制熔覆头到达目标点位置;继续按照之前的路径信息执行下一步熔覆处理。
本发明实施例提供的步骤S101之前还需进行:在设置有超声测距模块的熔覆头上最大半径值的基础上,进行一定的安全补偿,并设定安全阈值j、偏置值。
本发明实施例提供的安全高度和中间点生成包括:
安全高度的生成包括:位置判断模块对工件及夹具位置姿态识别后,获取其在Z轴方向上的最大高度值,并进行一定的安全补偿,得到安全高度;
中间点的生成包括:模拟夹具下一步运动,得到夹具及工件的运动轨迹;结合工件的三维模型对工件的外形轮廓进行偏置;选择改进欧式距离最短的点作为中间点,改进欧式距离公式如下:
其中,K为常数,当选择点与目标点之间存在障碍物时,K=1000;不存在障碍物时,K=0。
本发明实施例提供的环境地图可利用直接表示法、特征地图、拓扑地图和栅格地图的形式进行表示。
本发明实施例提供的路径规划模块包括A*算法、Dijkstra算法、RRT算法。
下面结合具体实施例对本发明的技术方案做进一步说明。
为使激光熔覆头在工作过程中,能够实时监控,避免激光熔覆头与工件发生碰撞,本发明在激光熔覆头上添加了一个带有环形随动装置的超声测距传感器,其安装形状如图1所示,紧固装置8通过拧紧紧固螺丝9,将环形齿轮内圈3锁紧在熔覆头1上,外套4上带有传感器安装孔和电机安装孔,使用螺丝6将超声波测距传感器5固定在外套上,随动装置电机7直接安装在外套4上面,通过电机7的转动带动整个外套4绕着环形齿轮内圈3转动,实现对超声波测距传感器测量方向的实时控制。
整个熔覆头防碰撞避障控制***工作示意图如图2所示,包括超声测距单元2,运动单元,电脑控制***12,其中运动单元包括机械臂10和水平旋转夹具11,电脑控制***包括碰撞检测模块、位置识别模块、位置判断模块、避障路径规划模块、运动控制模块。
熔覆头防碰撞避障控制***原理图如图4所示,包含控制层、作业层、监测层、信息层四个部分,其中控制层中所示模块仅表示功能实体,不一定必须与物理上独立的实体相对应。
下面对本案例中主要涉及的设备参数进行说明。熔覆头采用珠峰激光ZF-CH004A环形同轴激光熔覆头,加装超声测距单元后其最大半径为5cm;选用KUKA KR6ARC型工业机器人来作为熔覆头的运动执行机构,运动半径为1611mm,重复精度为±0.1mm;超声波测距传感器采用亿港电子YG-K003B2型传感器,误差为±1%。
本发明实施例中工件详细参数如图5所示,部分路径信息如下所示:
路径点 | X | Y | Z | 夹具旋转角θ |
熔覆区域1结束点 | -120.1 | -13.6 | 92.3 | 0° |
碰撞发生点 | -69.7 | -7.1 | 98.6 | 0° |
熔覆区域2起始点 | -13.2 | 20.1 | 75.9 | 90° |
结合具体装置及相应信息后,案例具体详细步骤如下所示:
步骤一、根据加装超声测距单元后熔覆头上最大半径进行安全阈值、偏置值的设定;本案例中最大半径为50mm,补偿值设定为20mm,因此安全阈值为70mm,偏置值为50mm。
步骤二、熔覆头由熔覆区域1的结束点运动到熔覆区域2的起始点,超声测距单元根据熔覆头移动路径信息实时调整超声测距传感器的探测方向,并将获得的信息反馈至碰撞检测模块,在运动到碰撞发生点时(图6)探测到的距离为69.9mm。
步骤三、碰撞检测模块将超声测距单元获取到的距离信息与提前设定的安全阈值进行比较,此时获取到的距离信息为69.9mm,小于安全阈值,立即将结果反馈至运动控制模块,运动控制模块对运动单元发出停止指令。
步骤四、当运动单元接收到停止指令后,位置识别模块根据先前输入的熔覆头移动路径信息和夹具运动路径信息对熔覆头及夹具当前位置和目标位置进行确认,此时熔覆头及夹具初始位置为(-69.7,-7.1,92.3),0°,目标位置为(-13.2,20.1,75.9),90°。
步骤五、运动判断模块在获得当前夹具旋转角0°后,与下一熔覆操作夹具目标旋转角90°进行对比,并将结果输出至运动控制模块;此时,0°≠90°,进入步骤五。
步骤六、位置识别模块对工件当前姿态进行识别,此时工件在Z轴方向上的最大值为75,对其进行安全补偿后安全高度设置为105;结合路径信息及工件三维模型对工件运动轨迹进行模拟,其结果如图7所示;当模拟夹具运动完成后,对工件的外形轮廓进行偏置,如图8;排除可加工区域内所有运动轨迹及轮廓偏置内的所有点后,选择距离目标点改进欧式距离最近的点,如图9,改进欧式距离计算公式如下:
其中,K为常数,当选择点与目标点之间存在障碍物时,K=1000,不存在障碍物时,K=0;通过此方法得出的中间点坐标为(-13.2,20.1,285.0)。
步骤七、运动控制模块对运动单元输出对机械臂Z轴方向上的驱动指令,提升熔覆头到安全高度105,再控制机械臂使熔覆头移动到中间点(-13.2,20.1,285.0);安全高度的设置是防止熔覆头移动到中间点的过程中与夹具或被熔覆物体发生碰撞,中间点的设置是防止夹具及其所夹的工件在运动过程中与熔覆头发生碰撞。
步骤八、运动控制单元对运动单元输出对夹具的驱动指令,控制夹具运动到目标旋转角90°。
步骤九、避障路径规划模块结合工件三维实体模型进行环境地图划分,再以中间点(-13.2,20.1,285.0)为起始点,使用相应的避障算法生成到目标点(-13.2,20.1,75.9)的路径,输出至运动控制单元;本案例中采用格栅法进行地图划分,利用A*算法进行避障路径规划。
栅格地图是指将机器人运行环境划分为一系列规则的大小相等的正方形栅格,每个栅格可以用一个数字来表示该栅格是可以通行的还是被障碍物占用的。在激光熔覆作业空间中,熔覆头所要避开的障碍物主要是不规则的零部件。因此采用栅格法建立的环境模型,将可通过区域、不可通过区域简化为栅格,熔覆头也转化一组栅格的集合,使熔覆头的三维路径规划问题转变为在一个可通过栅格集合中寻找一个满足规划要求的栅格子集问题,从而得到符合要求的最短路径。
A*算法,A*(A-Star)算法是一种静态路网中求解最短路径最有效的直接搜索方法,也是解决许多搜索问题的有效算法。其公式为:
f(n)=g(n)+h(n)
其中,f(n)是从初始状态经由状态n到目标状态的代价估计,
g(n)是在状态空间中从初始状态到状态n的实际代价,
h(n)是从状态n到目标状态的最佳路径的估计代价。
(对于路径搜索问题,状态就是图中的节点,代价就是距离)
步骤十、运动控制模块按避障路径规划模块生成的路径信息输出对运动单元机械臂的控制指令,使熔覆头到达目标点位置。
步骤十一、继续按照之前的路径信息执行下一步熔覆操作。
在本发明的描述中,除非另有说明,“多个”的含义是两个或两个以上;术语“上”、“下”、“左”、“右”、“内”、“外”、“前端”、“后端”、“头部”、“尾部”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。此外,术语“第一”、“第二”、“第三”等仅用于描述目的,而不能理解为指示或暗示相对重要性。
应当注意,本发明的实施方式可以通过硬件、软件或者软件和硬件的结合来实现。硬件部分可以利用专用逻辑来实现;软件部分可以存储在存储器中,由适当的指令执行***,例如微处理器或者专用设计硬件来执行。本领域的普通技术人员可以理解上述的设备和方法可以使用计算机可执行指令和/或包含在处理器控制代码中来实现,例如在诸如磁盘、CD或DVD-ROM的载体介质、诸如只读存储器(固件)的可编程的存储器或者诸如光学或电子信号载体的数据载体上提供了这样的代码。本发明的设备及其模块可以由诸如超大规模集成电路或门阵列、诸如逻辑芯片、晶体管等的半导体、或者诸如现场可编程门阵列、可编程逻辑设备等的可编程硬件设备的硬件电路实现,也可以用由各种类型的处理器执行的软件实现,也可以由上述硬件电路和软件的结合例如固件来实现。
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,都应涵盖在本发明的保护范围之内。
Claims (9)
1.一种激光熔覆熔覆头防撞避障控制***,其特征在于,所述激光熔覆熔覆头防撞避障控制***包括:
超声测距模块,包括超声测距传感器和环状随动装置;用于利用可调整位置的超声测距传感器进行超声测距;
控制模块,包括碰撞检测单元、位置识别单元、位置判断单元、避障路径规划单元、运动控制单元;用于进行数据处理、分析、位置识别、避障路径规划并生产控制指令;
执行模块,包括机械臂和夹具;用于接收并执行控制指令。
2.如权利要求1所述激光熔覆熔覆头防撞避障控制***,其特征在于,所述超声测距模块包括:
所述超声测距模块,包括超声测距传感器和环状随动装置,所述超声测距传感器和环状随动装置固定于熔覆头上;
所述环状随动装置用于根据熔覆头行进方向对超声测距传感器位置进行实时调整,令测量方向与行进方向的一致。
3.如权利要求1所述激光熔覆熔覆头防撞避障控制***,其特征在于,所述控制模块包括:
碰撞检测单元,用于接收超声测距模块反馈的信息并进行判断,同时将结果输出至运动控制单元;
位置识别单元,用于根据先前输入的路径信息及工件三维模型对熔覆头、夹具当前前位置及目标位置进行确认,并自动生成安全高度和中间点,将结果输入位置判断单元、避障路径规划单元和运动控制单元;
位置判断单元,用于通过对比当前的位置信息和目标位置信息,判断夹具或熔覆头是否还需运动;
避障路径规划单元,用于在获取到熔覆头与目标点的位置后,结合工件的三维模型建立环境模型,利用避障路径生产算法生成实时避障路径,并将路径信息输出至运动控制单元;
运动控制单元,用于接收来自位置识别单元、碰撞检测单元、位置判断单元、避障路径规划单元的信息,对接收信息进行处理,同时基于处理后的信息生成控制指令。
4.如权利要求3所述激光熔覆熔覆头防撞避障控制***,其特征在于,所述路径信息包括夹具的运动路径和熔覆头移动路径。
5.如权利要求1所述激光熔覆熔覆头防撞避障控制***,其特征在于,所述执行模块包括:
机械臂,用于控制熔覆头的运动;
夹具,用于调整被熔覆物体的位置。
6.一种应用于如权利要求1-5任意一项所述激光熔覆熔覆头防撞避障控制***的激光熔覆熔覆头防撞避障控制方法,其特征在于,所述激光熔覆熔覆头防撞避障控制方法包括:
步骤一,超声测距模块根据输入的熔覆头移动路径信息实时调整超声测距传感器的探测方向,并将获得的信息反馈至碰撞检测单元,并记录此时探测的距离i;
步骤二,碰撞检测单元将超声测距模块获取到的距离信息i与预先设定的安全阈值j进行比较,当i>j时,运动控制单元控制执行模块继续进行下一步熔覆处理;当i≦j时,将结果输出至运动控制单元,运动控制单元对执行模块发出停止指令,并转向步骤三;
步骤三,执行模块接收停止指令后,位置识别单元根据预先输入的熔覆头移动路径信息和夹具运动路径信息确认熔覆头及夹具当前位置和目标位置;
步骤四,运动判断单元在获得当前夹具旋转角θ1后,与下一熔覆操作夹具目标旋转角θ2进行对比,并将结果输出至运动控制单元;当θ1=θ2时,转向步骤六;θ1≠θ2时,转向步骤五;
步骤五,位置识别单元根据路径信息以及工件三维模型对当前工件及夹具位置姿态进行识别,同时遍历夹具转动过程中夹具及工件的轨迹点,对工件外形轮廓进行一定的偏置,并自动生成安全高度和中间点位置;
步骤六,运动控制单元对执行模块输出对机械臂Z轴方向上的驱动指令,提升熔覆头到安全高度h,再控制机械臂使熔覆头移动到中间点位置;
步骤七,熔覆头移动到中间点后,运动控制单元根据位置判断单元输入的信息对执行模块输出对夹具的驱动指令,控制夹具运动到目标位置;
步骤八,避障路径规划单元结合工件三维实体模型进行环境地图划分,再根据位置识别单元输入的熔覆头目标点位置,以中间点位置为起始点,利用路径规划算法生成到目标点的路径,输出至运动控制单元;
步骤九,运动控制单元按避障路径规划单元生成的路径信息输出对运动单元机械臂的控制指令,控制熔覆头到达目标点位置;继续按照之前的路径信息执行下一步熔覆处理。
7.如权利要求6所述激光熔覆熔覆头防撞避障控制方法,其特征在于,所述步骤一之前还需进行:在设置有超声测距模块的熔覆头上最大半径值的基础上,进行一定的安全补偿,并设定安全阈值j、偏置值;
所述安全高度和中间点生成包括:
所述安全高度的生成包括:位置判断模块对工件及夹具位置姿态识别后,获取其在Z轴方向上的最大高度值,并进行一定的安全补偿,得到安全高度。
9.一种熔覆头防碰撞装置,其特征在于,所述熔覆头防碰撞装置搭载权利要求1~5任意一项所述激光熔覆熔覆头防撞避障控制***。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111038538.8A CN113985807B (zh) | 2021-09-06 | 2021-09-06 | 一种用于激光熔覆的熔覆头防撞避障控制***及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111038538.8A CN113985807B (zh) | 2021-09-06 | 2021-09-06 | 一种用于激光熔覆的熔覆头防撞避障控制***及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113985807A true CN113985807A (zh) | 2022-01-28 |
CN113985807B CN113985807B (zh) | 2023-12-26 |
Family
ID=79735349
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111038538.8A Active CN113985807B (zh) | 2021-09-06 | 2021-09-06 | 一种用于激光熔覆的熔覆头防撞避障控制***及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113985807B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114686877A (zh) * | 2022-03-03 | 2022-07-01 | 武汉点金激光科技有限公司 | 一种轴类件激光熔覆机及激光熔覆加工*** |
CN115194183A (zh) * | 2022-07-20 | 2022-10-18 | 西安增材制造国家研究院有限公司 | 一种增材制造设备用激光熔覆头智能防撞*** |
CN116039264A (zh) * | 2022-10-31 | 2023-05-02 | 季华实验室 | 多轴运动平台的控制方法、装置、终端设备以及存储介质 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104674210A (zh) * | 2013-12-02 | 2015-06-03 | 齐欢 | 一种工件激光自动化修复方法 |
CN105479490A (zh) * | 2015-12-24 | 2016-04-13 | 华中科技大学 | 一种双机器人实时动态避障装置及其避障方法 |
KR101790154B1 (ko) * | 2016-05-25 | 2017-10-26 | 경북대학교 산학협력단 | Cam 파일을 자동 생성하는 레이저 클래딩 방법 및 시스템 |
CN108441858A (zh) * | 2018-06-05 | 2018-08-24 | 东北大学 | 零件加工中基于激光熔覆技术的变参数路径扫描算法 |
CN109029453A (zh) * | 2018-07-13 | 2018-12-18 | 南方科技大学 | 熔覆头姿态路径规划方法、装置、终端、存储介质及*** |
CN111174752A (zh) * | 2019-08-20 | 2020-05-19 | 西安必盛激光科技有限公司 | 用于内孔熔覆的激光头实时在线防撞监测装置及监测方法 |
CN111364039A (zh) * | 2020-03-26 | 2020-07-03 | 陕西天元智能再制造股份有限公司 | 一种激光熔覆自调节装置和自调节方法 |
CN111551940A (zh) * | 2020-04-13 | 2020-08-18 | 北京机科国创轻量化科学研究院有限公司 | 一种激光熔覆头的防撞方法 |
-
2021
- 2021-09-06 CN CN202111038538.8A patent/CN113985807B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104674210A (zh) * | 2013-12-02 | 2015-06-03 | 齐欢 | 一种工件激光自动化修复方法 |
CN105479490A (zh) * | 2015-12-24 | 2016-04-13 | 华中科技大学 | 一种双机器人实时动态避障装置及其避障方法 |
KR101790154B1 (ko) * | 2016-05-25 | 2017-10-26 | 경북대학교 산학협력단 | Cam 파일을 자동 생성하는 레이저 클래딩 방법 및 시스템 |
CN108441858A (zh) * | 2018-06-05 | 2018-08-24 | 东北大学 | 零件加工中基于激光熔覆技术的变参数路径扫描算法 |
CN109029453A (zh) * | 2018-07-13 | 2018-12-18 | 南方科技大学 | 熔覆头姿态路径规划方法、装置、终端、存储介质及*** |
CN111174752A (zh) * | 2019-08-20 | 2020-05-19 | 西安必盛激光科技有限公司 | 用于内孔熔覆的激光头实时在线防撞监测装置及监测方法 |
CN111364039A (zh) * | 2020-03-26 | 2020-07-03 | 陕西天元智能再制造股份有限公司 | 一种激光熔覆自调节装置和自调节方法 |
CN111551940A (zh) * | 2020-04-13 | 2020-08-18 | 北京机科国创轻量化科学研究院有限公司 | 一种激光熔覆头的防撞方法 |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114686877A (zh) * | 2022-03-03 | 2022-07-01 | 武汉点金激光科技有限公司 | 一种轴类件激光熔覆机及激光熔覆加工*** |
CN115194183A (zh) * | 2022-07-20 | 2022-10-18 | 西安增材制造国家研究院有限公司 | 一种增材制造设备用激光熔覆头智能防撞*** |
CN116039264A (zh) * | 2022-10-31 | 2023-05-02 | 季华实验室 | 多轴运动平台的控制方法、装置、终端设备以及存储介质 |
CN116039264B (zh) * | 2022-10-31 | 2023-09-22 | 季华实验室 | 多轴运动平台的控制方法、装置、终端设备以及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN113985807B (zh) | 2023-12-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113985807A (zh) | 一种激光熔覆熔覆头防撞避障控制***及方法 | |
CN106557844B (zh) | 一种焊接机器人路径规划方法 | |
US8352074B2 (en) | Path planning apparatus and method of robot | |
CN206474704U (zh) | 一种激光视觉自动钻孔装置 | |
US7937186B2 (en) | Device and method for automatically setting interlock between robots | |
US10228686B2 (en) | Robot programming device for teaching robot program | |
CN110653826B (zh) | 一种面向传送带目标跟随的机器人实时轨迹规划方法 | |
CN111673755A (zh) | 一种基于视觉伺服的采摘机器人控制***及控制方法 | |
Ma et al. | A fast and robust seam tracking method for spatial circular weld based on laser visual sensor | |
CN110815226B (zh) | 一种机器人任意姿态任意位置下回初始位置的方法 | |
Fan et al. | An automated reconfigurable flexible fixture for aerospace pipeline assembly before welding | |
CN114089767A (zh) | 一种移动式复合机器人应用中瓶状物的定位与抓取方法 | |
CN112872435B (zh) | 一种ac型双摆头五轴联动机床多轴伺服匹配方法及装置 | |
CN114750146A (zh) | 一种机器人铣削轨迹精度补偿方法 | |
CN111300409A (zh) | 一种工业机器人路径规划方法 | |
CN114739290B (zh) | 线激光扫描化铣胶刻线的路径规划方法及*** | |
Cong | Combination of two visual servoing techniques in contour following task | |
KR20140040689A (ko) | 구조 부재의 가공 방법 | |
CN114161418B (zh) | 机器人的工具坐标的校准方法和装置、机器人和存储介质 | |
Kulkarni et al. | Using unsupervised learning for regulating deposition speed during robotic wire arc additive manufacturing | |
Wada et al. | Dynamic collision avoidance method for co-worker robot using time augmented configuration-space | |
Kim et al. | Improvement of Door Recognition Algorithm using Lidar and RGB-D camera for Mobile Manipulator | |
Katsuki et al. | Graph search based local path planning with adaptive node sampling | |
CN111026163B (zh) | 一种面向室内的失控放射源自主搜寻机器人及其搜寻方法 | |
CN112558045A (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 |