CN109876968A - 一种钢结构机器人喷涂自动路径规划方法 - Google Patents

一种钢结构机器人喷涂自动路径规划方法 Download PDF

Info

Publication number
CN109876968A
CN109876968A CN201910222560.4A CN201910222560A CN109876968A CN 109876968 A CN109876968 A CN 109876968A CN 201910222560 A CN201910222560 A CN 201910222560A CN 109876968 A CN109876968 A CN 109876968A
Authority
CN
China
Prior art keywords
spraying
robot
primitive
path planning
control during
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
Application number
CN201910222560.4A
Other languages
English (en)
Other versions
CN109876968B (zh
Inventor
郑龙
郑磊
冯海生
平国祥
陈圣亮
储昭琦
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Ximeiai (wuhu) Robot Technology Co Ltd
Original Assignee
Ximeiai (wuhu) Robot Technology Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Ximeiai (wuhu) Robot Technology Co Ltd filed Critical Ximeiai (wuhu) Robot Technology Co Ltd
Priority to CN201910222560.4A priority Critical patent/CN109876968B/zh
Publication of CN109876968A publication Critical patent/CN109876968A/zh
Application granted granted Critical
Publication of CN109876968B publication Critical patent/CN109876968B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Abstract

本发明涉及机器人喷涂加工领域,具体是一种钢结构机器人喷涂自动路径规划方法,其具体步骤如下:A、模式选择;B、建立坐标系并导入机器人模型、工件模型及设定参数;C、生成用于碰撞检测的网格模型;D、生成几何基元列表并转换为喷涂基元列表;E、喷涂基元路径规划并生成工件的完整喷涂路径;F、机器人关节臂运动规划;G、检查关节臂的速度和加速度是否超限;H、细节路径规划并生成喷涂程序。本发明实现了多姿态平面组合型构件,例如典型钢结构件的机器人喷涂自动路径规划方法,所输出的喷涂程序可直接在实际机器人控制器中运行;与人工示教作业相比,使用该方法可降低操作者的劳动强度,改善操作者的工作环境,易于集中处理相关污染源。

Description

一种钢结构机器人喷涂自动路径规划方法
技术领域
本发明涉及机器人喷涂加工领域,具体是一种钢结构机器人喷涂自动路径规划方法。
背景技术
当前钢结构行业的喷涂普遍采用人工作业,人工作业的方式存在诸多问题:喷涂质量一致性较差、效率偏低、操作者存在健康隐患、造成一定的环境污染等等。与其相比,机器人喷涂系统具有可重复性好、喷涂质量稳定、工作效率高、可集中处理相关污染源类优点。
在机器人喷涂应用中,喷涂路径规划问题一直是难点和研究热点之一,而喷涂路径规划又可以分解为两方面:1.机器人第六轴末端工具在工件表面的喷涂路径规划,简称为路径规划;2.机器人各关节臂的运动轨迹规划,简称为轨迹规划。对于具体的喷涂应用,研究者更关注的是前者,因为只需为后者选择一种通用的机器人轨迹规划算法即可。
典型钢结构件具有以下特点:1.从几何上看,它是由多种不同位置姿态的平面所组合而成的较复杂三维构件;2.在某个维度,假设为y方向,其尺寸远大于另外两个维度的尺寸,且y方向尺寸远超出六自由度喷涂机器人的工作范围;3.几乎所有的外表面都要求被涂料所覆盖。因此,在钢结构喷涂应用中,目前公开发表的路径规划方法几乎不能胜任。
如中国专利公开号为201510680245.8的大平面自动喷涂设备轨迹规划及控制方法中给出了一种适用于大平面的路径规划方法,但它只能处理单一平面,不能处理像钢结构这种由许多不同位置姿态平面组合而成的工件。
目前有不少用于解决自由曲面喷涂路径规划的方法。如中国专利公开号为CN201210050434.3的一种自由曲面喷涂机器人的喷枪轨迹规划方法、中国专利公开号为CN201410545718.9的一种大型自由曲面的喷涂机器人站位规划方法、中国专利公开号为CN201611049007.8的一种自动化喷涂系统集成喷涂工艺的喷涂路径规划算法,它们同样不能处理像钢结构这样的较复杂空间构件。此外,这些喷涂路径规划方法的计算效率偏低,很难满足实际工业生产中的时间节拍要求。
综上,钢结构行业的急切需求是:一种路径规划方法,能实现针对钢结构的喷涂路径自动规划,且尽量满足实际生产的节拍要求。
发明内容
基于对钢结构件的分析,设想钢结构机器人喷涂系统由布置在工件长度方向两侧的两台六自由度喷涂机器人协作完成其喷涂作业。为了解决该喷涂系统的路径规划问题,本发明提出一种钢结构机器人喷涂自动路径规划方法。
一种钢结构机器人喷涂自动路径规划方法,其具体步骤如下:
A、模式选择:选择喷涂系统的布置模式为输送线模式或者第七轴模式;
B、建立坐标系并导入机器人模型、工件模型及设定参数;
C、生成用于碰撞检测的网格模型;
D、生成几何基元列表并转换为喷涂基元列表;
E、对各喷涂基元进行路径规划,生成工件的完整喷涂路径;
F、机器人关节臂运动规划:根据喷涂路径以及机器人工作速度和加速度信息,给出机器人六个关节臂的速度曲线和加速度曲线;
G、检查关节臂的速度和加速度是否超限:检查机器人关节空间的速度、加速度是否超限,若超限则计算出超限因子,并据此减小笛卡尔移动速度和加速度、旋转速度和加速度;
H、细节路径规划并生成喷涂程序:根据高度值height与喷涂间距参数interval之间的相对大小关系,进行细节路径规划并按照制定的规范自动生成最终的喷涂程序,整个规划过程结束。
所述步骤A的输送线模式,由输送线带着工件移动来实现工件整体与机器人之间的平移运动;
所述步骤A的第七轴模式,由线性附加轴带着机器人移动来实现工件整体与机器人之间的平移运动。
所述步骤B中设定参数的第一部分是机器人工作参数;
第二部分是其它设备的工作参数;
第三部分是路径规划相关参数;
第四部分是程序生成相关参数。
所述步骤D中将几何基元转换为喷涂基元的处理操作,包括对梯形类几何基元的处理:依据梯形分割准则,将其转换为相应类型的喷涂基元。
所述步骤D中将几何基元转换为喷涂基元的处理操作,包括对平行四边形类几何基元的处理:依据最小基元阈值和线-面阈值参数,将其转换为相应类型的喷涂基元。
所述步骤D中将几何基元转换为喷涂基元的处理操作,包括对公共区域的处理:依据公共区域识别及其宽度阈值参数,将属于公共区域的几何基元转换为相应类型的喷涂基元,并分配给对应的机器人。
所述步骤D中将几何基元转换为喷涂基元的处理操作,包括对锐边邻接区域的处理:依据锐边识别及靠近锐边部分宽度参数,将锐边邻接区域转换为相应类型的喷涂基元。
所述步骤D中将几何基元转换为喷涂基元的处理操作,包括基于偏移量的修正处理:依据偏移量参数,对梯形类、平行四边形类几何基元进行修正处理,以控制其喷涂效果。
所述步骤E中的步骤为a、为分段长度或者位移百分比选择初值,所述初值通常取最大值;
b、选取喷枪角度初值,通常初选0°,通过函数R2E()将选定的喷枪角度转换为三个欧拉角,即姿态坐标,并获得对应的工件整体位移坐标或第七轴位移坐标;
c、根据路径点位姿坐标,使用空间解析几何方法和机器人逆运动学算法,计算出机器人关节空间的六维坐标(J1,J2,J3,J4,J5,J6);
d、关节角度超限检测:检查(J1,J2,J3,J4,J5)是否超出步骤B中设定的限制区间,若J1~J5超限,则首先尝试跳到步骤b中为喷枪角度选取新值,若已超出喷枪角度的取值范围则跳到步骤a中为分段长度或者位移百分比选取新值;若J1~J5没超限,则直接执行下一步;
e、笛卡尔空间z向超限检测:检查此时的机器人第六轴末端点的z坐标z6是否超出设定的限制区间并进行调整;
f、绕管检测:检查J6是否超出步骤B中设定的限制区间,如超限则根据J6与限制区间的关系添加过渡点;
g、碰撞检测:依据枪尖点和第六轴末端点的位姿坐标检查是否发生碰撞;如果有碰撞现象则根据碰撞发生时工件与喷枪之间的相对位置姿态关系,在喷涂路径中添加两个避让点。
本发明的有益效果是:本发明实现了多姿态平面组合型构件,例如典型钢结构件的机器人喷涂自动路径规划方法,所输出的喷涂程序可直接在实际机器人控制器中运行;与人工示教作业相比,使用该方法可降低操作者的劳动强度,改善操作者的工作环境,提高喷涂质量的一致性和生产效率,易于集中处理相关污染源。
附图说明
下面结合附图和实施例对本发明进一步说明。
图1为本发明的输送线模式布局示意图;
图2为本发明的第七轴模式布局示意图;
图3为本发明的自动路径规划流程图;
图4为本发明的自定义XML模型图;
图5为本发明的梯形分割准则示意a图;
图6为本发明的梯形分割准则示意b图;
图7为本发明的梯形分割准则示意c图;
图8为本发明的梯形分割准则示意d图;
图9为本发明的复杂平面连通域的分割示意图;
图10为本发明的公共区域处理示意图;
图11为本发明的锐边检测原理图;
图12为本发明的锐边邻接区域处理示意图;
图13为本发明的沿短边方向的偏移量修正示意图;
图14为本发明的沿长边方向的偏移量修正示意图;
图15为本发明的平行四边形细节路径规划示意a图;
图16为本发明的平行四边形细节路径规划示意b图;
图17为本发明的平行四边形细节路径规划示意c图。
具体实施方式
为了使本发明实现的技术手段、创作特征、达成目的与功效易于明白了解,下面对本发明进一步阐述。
考虑到典型钢结构件长度方向的尺寸远大于另外两个维度方向的尺寸,且长度方向尺寸远超出普通六自由度喷涂机器人的工作范围。因此,设想钢结构机器人喷涂系统由布置在工件长度方向两侧的两台六自由度喷涂机器人协作完成其喷涂作业,且该喷涂系统中需要实现工件整体与机器人之间的平移运动。本发明提出的自动路径规划方法正是为了解决该喷涂系统的路径规划问题。
如图1至图17所示,一种钢结构机器人喷涂自动路径规划方法,其具体步骤如下:
A、模式选择:选择喷涂系统的布置模式为输送线模式或者第七轴模式;
B、建立坐标系并导入机器人模型、工件模型及设定参数;
C、生成用于碰撞检测的网格模型;
D、生成几何基元列表并转换为喷涂基元列表;
E、对各喷涂基元进行路径规划,生成工件的完整喷涂路径;
F、机器人关节臂运动规划:根据喷涂路径以及机器人工作速度和加速度信息,给出机器人六个关节臂的速度曲线和加速度曲线;
G、检查关节臂的速度和加速度是否超限:检查机器人关节空间的速度、加速度是否超限,若超限则计算出超限因子,并据此减小笛卡尔移动速度和加速度、旋转速度和加速度;
H、细节路径规划并生成喷涂程序:根据高度值height与喷涂间距参数interval之间的相对大小关系,进行细节路径规划并按照制定的规范自动生成最终的喷涂程序,整个规划过程结束。
所述步骤A的输送线模式,由输送线带着工件移动来实现工件整体与机器人之间的平移运动;该模式的喷涂系统中,设置有用于输送工件5的输送线3、设置在输送线3上用于装夹工件5的装夹装置4、分别设置在输送线3两侧的R1机器人1和R2机器人2。
其工作过程为:由输送线3带着工件5移动,首先进入R2机器人2的工作区域,然后输送线3暂停,R2机器人2开始喷涂作业;该段喷涂作业完成之后,输送线3带着工件5继续移动,进入下一个工作段,然后输送线暂停,R1机器人1、R2机器人2同时进行喷涂作业;工件到达最后一个喷涂位置后,由R1机器人1完成剩余的喷涂作业。
所述步骤A的第七轴模式,由线性附加轴带着机器人移动来实现工件整体与机器人之间的平移运动;该模式的喷涂系统中,设置有用于装夹工件5的装夹装置4、分别设置在工件5两侧的R1线性附加轴6和R2线性附加轴7、分别安装在线性附加轴6和7上的R1机器人1和R2机器人2。
其工作过程为:由R1机器人1从工件5的最左边开始喷涂作业,R2机器人2从工件5的最右边开始喷涂作业;等到R1机器人1和R2机器人2分别完成避让区一侧左半部分和避让区另一侧右半部分的喷涂之后,R2机器人2退回到一个安全点,由R1机器人1先完成避让区左侧的喷涂作业;然后R1机器人1退回到一个安全点,再由R2机器人2完成避让区右侧的喷涂作业,此时避让区的喷涂作业结束;然后再由R1机器人1和R2机器人2分别完成避让区一侧右半部分和避让区另一侧左半部分的喷涂,从而完成整个工件的喷涂作业。
所述的步骤B的建立坐标系为:依次建立世界坐标系Fw、机器人基坐标系Fb1和Fb2、工件坐标系Fp、R1机器人1的工具坐标系Ft11和Ft12、R2机器人2的工具坐标系Ft21和Ft22
所述步骤B中的世界坐标系Fw,其原点为相对于大地固定不动的一个点,其x、y、z三个坐标轴方向与R1机器人1的基坐标系Fb1的对应方向相同。
所述步骤B中的机器人基坐标系Fb1,其原点为R1机器人1底座中心点,其y轴方向为工件的长度方向,z轴方向为竖直向上,x轴方向为满足右手法则的另一个方向。
所述步骤B中的机器人基坐标系Fb2,其原点为R2机器人2底座中心点,其z轴与Fb1的z轴同向,其x轴是Fb1的x轴反向,其y轴是Fb1的y轴反向。
所述步骤B中的工件坐标系Fp,其原点为工件5上表面的任一点,其x、y、z三个坐标轴的方向与世界坐标系Fw的对应方向相同。
所述步骤B中的R1机器人1的工具坐标系Ft11和Ft12,其原点为R1机器人1第六轴末端法兰的中心点,然后根据枪架和设定的初始喷枪姿态,分别用六维位姿坐标(xt11,yt11,zt11,at11,bt11,ct11)和(xt12,yt12,zt12,at12,bt12,ct12)来描述Ft11和Ft12;例如,典型的Ft11和Ft12,可分别用(40,-120,180,0,45,0)和(80,-150,100,60,0,0)来描述。
所述步骤B中的R2机器人2的工具坐标系Ft21和Ft22,其原点为R2机器人2第六轴末端法兰的中心点,然后根据枪架和设定的初始喷枪姿态,分别用六维位姿坐标(xt21,yt21,zt21,at21,bt21,ct21)和(xt22,yt22,zt22,at22,bt22,ct22)来描述Ft21和Ft22
为确定步骤B中机器人基坐标系Fb1、Fb2及工件坐标系Fp之间的具体相对位置,实际实施时,需要根据最大钢构和最小钢构的尺寸,在机器人离线仿真软件中进行测试,以给出钢构喷涂系统中各部分的合理布局位置。
所述步骤B中的模型可为STEP模型或自定义XML模型。
自定义XML模型是发明者团队自定义的一种XML格式文本,可用来表示较简单的钢结构件模型;所谓较简单模型,是指该模型可由简单几何体直接组合到一起而生成,且无需简单几何体之间的布尔操作,包括交操作、并操作和差操作;所谓简单几何体是指可由平面轮廓经单次拉伸操作而生成的几何体。
实际操作中,若导入的是STEP模型,则可由意大利软件公司devDept发布的Eyeshot图形控件中的函数ReadStep()来生成其对应的三维实体对象;若导入的是自定义XML模型,则可由Eyeshot图形控件中相应的几何实体生成函数来生成构件的三维实体对象;有了三维实体对象以后,可使用Eyeshot图形控件中的函数ConvertToMesh(),将其转换为构件的网格模型。
所述步骤B中设定参数的第一部分是机器人工作参数,包括:各关节臂的角度限制、角速度限制、角加速度限制,第六轴末端的笛卡尔移动速度和加速度、旋转速度和加速度,机器人工作空间限制。
第二部分是其它设备的工作参数:
a、对于输送线模式,这部分指输送线的工作参数,包括运动速度、运动方向;
b、对于第七轴模式,这部分指第七轴的工作参数,包括运动速度、工作行程。
第三部分是路径规划相关参数:
a、输送线模式特有的参数,包括:分段长度的取值范围和变化步长值、前伸长度;
b、第七轴模式特有的参数,包括:第七轴移动位移与总位移的百分比的取值范围和变化步长值、中间段避让区长度;
c、两种模式共同的参数,包括:工具号分配准则、梯形分割准则、最小基元阈值与线-面阈值、公共区域的范围及其宽度阈值、靠近锐边部分宽度、偏移量、喷涂顺序准则、喷枪角度的取值范围和变化步长值、摆枪范围、喷枪及枪架的尺寸参数和避免碰撞的避让距离;
第四部分是程序生成相关参数,包括:先验的工艺参数、机器人安全距离、喷涂间距interval、过渡部分的运行速度。
所述步骤B中第三部分的分段长度的取值范围和变化步长值,是输送线模式中用来控制规划迭代过程的变量。例如,当分段长度的取值范围为1000mm~1500mm、变化步长为100mm时,则在规划迭代过程中,分段长度将依次取值为1500、1400、1300、1200、1100和1000,单位是mm。
所述步骤B中第三部分的第七轴移动位移与总位移的百分比的取值范围和变化步长值,是第七轴模式中用来控制规划迭代过程的变量。例如,当第七轴移动位移与总位移的百分比的取值范围为60%~80%、变化步长为5%时,则在规划迭代过程中,此百分比将依次取值为80%、75%、70%、65%、60%。
所述步骤B中第三部分的工具号分配准则,是指按某种规则给每个平面区域分配一个喷涂工具号,例如按平面区域法向量所属的卦限来分配。一个三维空间有8个卦限。喷涂系统中有两台机器人,每台机器人有两个工具坐标系,则将这8个卦限均匀分配给每个工具坐标系,即每个工具坐标系负责2个卦限。例如,当一个平面区域的法向量属于第一卦限时,则由分割该平面区域而获得的所有喷涂基元都将由负责第一卦限的工具坐标系来处理。
所述步骤B中第三部分的喷枪角度的取值范围和变化步长值,是根据喷涂效果而设置的先验参数。所谓的喷枪角度,是指喷涂时喷枪轴线与所喷涂平面区域的法向量之间的夹角。例如,当喷枪角度的取值范围为0°~20°、变化步长为5°时,则喷枪角度可取为0°、5°、10°、15°、20°。
所述步骤B的第四部分中的先验的工艺参数包括:喷涂距离、喷涂速度、流量、雾化值、扇形角度值。
所述步骤C的网格模型,由两部分组成:第一部分包括工件、输送线及装夹装置,第二部分包括喷枪和枪架、机器人的第四、第五和第六关节臂。第二部分网格模型的生成,需要使用步骤B第三部分参数中的喷枪及枪架尺寸参数。
实际实施时,可使用计算机图形库相关函数,例如Eyeshot图形控件的函数ConvertToMesh(),生成相应的网格模型。为了提高计算效率,尽量用球体、圆柱体、圆锥体、长方体等简单三维几何体的组合来表示碰撞检测中涉及的物体。
所述步骤D生成几何基元列表的过程是:分析工件的三维实体模型,依据其表面几何信息和拓扑信息,得到由一系列平面区域所组成的一个列表,它表征工件的外轮廓;然后根据工具号分配准则和平面区域的姿态,为每个平面区域分配一个喷涂工具号;再依次将列表中的每一个平面区域分割为一系列的几何基元,即可得到几何基元列表。
所述步骤D的几何基元,其类型包括:梯形、平行四边形、三角形;如图5所示的平面连通域,它可被分割为八个几何基元,包括四个梯形类基元和四个平行四边形类基元。
所述步骤D的喷涂基元,其类型包括:线段、平行四边形、梯形、三角形。
所述步骤D中将几何基元转换为喷涂基元的处理操作,包括:
a、对梯形类几何基元的处理:依据步骤B中第三部分的梯形分割准则,将其转换为相应类型的喷涂基元;
所谓的梯形分割准则,即指定对梯形类几何基元的喷涂方式;如图6~图9所示,可以将梯形当作一个整体进行喷涂,也可以将梯形分割为一个平行四边形和一个三角形;当进行分割处理时,则对所获得的三角形又有三种处理方式,第一种是将该三角形补全为一个虚拟平行四边形,第二种是指定数条平行于三角形最大边长方向的喷涂路径,第三种是在三角形中指定一条样条曲线喷涂路径;
b、对平行四边形类几何基元的处理:依据步骤E中第三部分的最小基元阈值和线-面阈值参数,将其转换为相应类型的喷涂基元;
当平行四边形短边方向的高度值小于最小基元阈值时,该几何基元将被忽略;当高度值大于等于最小基元阈值但小于线-面阈值时,则该几何基元将被转换为线段类喷涂基元,即其喷涂路径为一条沿长度方向的中线;当高度值大于等于线-面阈值时,则该几何基元将被转换为平行四边形类喷涂基元;
c、对公共区域的处理:所谓的公共区域,是指两台机器人中的任一台都有可能可以完成其喷涂作业的区域;当公共区域的尺寸过大,则由单台机器人独自来完成其喷涂很可能出现奇异点或者接近奇异姿态的问题;
首先依据公共区域的范围参数来判断某个几何基元是否属于公共区域。如果其属于公共区域,则将该基元的短边方向高度值与公共区域宽度阈值进行对比,如果高度值小于宽度阈值,则不对该基元进行分割处理。如果高度值大于等于高度阈值,则将该基元分割为两个喷涂基元,并分配给对应的机器人进行喷涂作业;
d、对锐边邻接区域的处理:考虑到所处理的工件表面模型为正则的流形曲面模型,其中每条边有且仅有两个父面;所谓的锐边,是指由该边及其两个父平面所定义的二面角小于π;
考虑到算法的效率,锐边检测过程如图11所示;待检测边为Etest,找到Etest的中点Pem,在父平面1内,找出过点Pem且垂直于边Etest的直线Lp,在直线Lp上找到距离点Pem为面1宽度值一半的两个点Ppm和P2,找出过点Ppm的面1的法线Npm。在法线Npm上找到距离点Ppm为10mm的点P1;连接点P1和P2,得到直线Ltest;检测Ltest与父平面2是否有交点;为保证算法的稳定性,将上述检测过程中面1和面2的角色对调,重复一遍上述检测过程;若在这两个检测过程中发现交点,则边Etest为锐边,否则,边Etest为非锐边;
对锐边邻接区域的处理,如图12所示:当锐边的父平面的宽度值小于等于步骤B中第三部分的靠近锐边部分宽度参数值时,认为喷枪对着锐边喷涂时已经覆盖了其邻接区域,因此将锐边邻接区域从几何基元列表中移除,且在喷涂基元列表中添加一个线段型基元;当锐边的父平面的宽度值大于靠近锐边部分宽度参数值时,将每个父平面分割为两部分,即将父平面1分割为面1靠近锐边部分和面1单独喷涂部分,将父平面2分割为面2靠近锐边部分和面2单独喷涂部分,面1靠近锐边部分和面2靠近锐边部分由喷枪对着锐边一次喷涂完成,面1单独喷涂部分和面2单独喷涂部分则分别进行独立喷涂作业;
e、基于偏移量的修正处理:步骤B中第三部分的偏移量,是喷涂效果的控制参数;偏移量可正可负,若偏移方向指向平面内部,则偏移量为正,反之则为负;如图13和图14所示,有两种类型的偏移,即沿短边方向的偏移和沿长边方向的偏移。
所述步骤E对各喷涂基元进行路径规划时,首先需要对喷涂基元列表进行排序操作:根据步骤B第三部分设定的喷涂顺序准则,对列表中的喷涂基元进行排序操作。
所述步骤E的路径规划,其步骤为:a、若为输送线模式,则在步骤B所设定的取值范围内,为分段长度选择初值;若为第七轴模式,则在步骤B所设定的取值范围内,为第七轴移动位移与总位移百分比选择初值;所述初值通常取最大值;
b、在步骤B所设定的取值范围内,选取喷枪角度初值,通常初选0°,并根据步骤B中设定的摆枪参数,由函数R2E()将选定的喷枪角度转换为三个欧拉角,即姿态坐标,从而得到该喷涂基元各个关键点的喷涂位姿(xp,yp,zp,ap,bp,cp)i,1≤i≤N,N为关键点的数量;此六维坐标是在基坐标系Fb1或Fb2中度量的;若为输送线模式,还将获得对应的工件整体位移坐标;若为第七轴模式,还将获得对应的第七轴位移坐标;
c、由每个路径关键点的六维坐标(xp,yp,zp,ap,bp,cp),喷涂距离Ds和所用的工具坐标系Ft(xt,yt,zt,at,bt,ct),使用空间解析几何学方法,计算出枪尖点的位姿六维坐标(xg,yg,zg,ag,bg,cg)和第六轴末端法兰中心点的位姿六维坐标(x6,y6,z6,a6,b6,c6)。再利用机器人逆运动学算法,计算出机器人关节空间的六维坐标(J1,J2,J3,J4,J5,J6);
d、关节角度超限检测:检查(J1,J2,J3,J4,J5)是否超出步骤B中设定的限制区间,若J1~J5超限,则首先尝试跳到步骤b中为喷枪角度选取新值,若已超出喷枪角度的取值范围则跳到步骤a中为分段长度或者位移百分比选取新值;若J1~J5没超限,则直接执行下一步;
e、笛卡尔空间z向超限检测:检查此时的机器人第六轴末端点的z坐标z6,是否超出步骤B中设定的限制区间:如果z6超限,则使枪尖点位置坐标(xg,yg,zg)保持不变,使喷枪绕该点进行旋转,直至z6不超限,计算出微调后的枪尖点姿态坐标(a'g,b'g,c'),再计算出微调后的第六轴法兰中心点(x'6,y'6,z'6,a'6,b'6,c'6),以及微调后的关节空间坐标(J'1,J'2,J'3,J'4,J'5,J'6)。如果z6不超限,则直接执行下一步。
f、绕管检测:检查J6或者J'6是否超出步骤B中设置的限定区间,若超限,表明存在绕管风险,则根据J6或者J'6与限制区间的关系添加过渡点,然后继续执行下一步;若没超限,则直接执行下一步;
生成避免绕管过渡点的过程是:假定步骤B中设定的J6限制区间为-360°~+360°;如果喷涂路径上点P对应的J6小于-360°,则在点P附近增加一个过渡点,使其绕机器人第六轴正向旋转一周,即增加360°;如果点P对应的J6大于360°,则在点P附近增加一个过渡点,使其绕机器人第六轴反向旋转一周,即减小360°。
g、碰撞检测:依据此时枪尖点和第六轴末端点的位姿坐标,将步骤C中生成的两部分网格模型布置到世界坐标系Fw中,检查这两部分之间是否发生碰撞;如果发生碰撞,则根据碰撞发生时工件与喷枪之间的相对位置姿态关系和步骤B中避让距离参数,在喷涂路径中添加两个避让点,然后执行下一步;若没有碰撞,则直接执行下一步。
所述步骤E中得到完整喷涂路径之后,如果该路径过于散乱,则可以扩大对机器人第六轴的角度限制,即根据需要增大上限或者减小下限,则可防止因避免绕管而增加太多的过渡点,从而可生成更顺畅的喷涂路径。
所述步骤H的细节路径规划,对于平行四边形类喷涂基元,其具体过程为:如图15~17所示,假设平行四边形喷涂基元的短边方向高度为height,步骤B中喷涂间距参数为interval,喷涂该基元时喷枪的开启次数表示为num_pass,令n=height/interval:
当0<n<1.5时,num_pass=2;
当1.5≤n<2.5时,num_pass=3;
当2.5≤n<3.5时,num_pass=4。
所述步骤H按照制定的规范自动生成最终的喷涂程序,其具体过程为:
a、对于输送线模式,将每次输送线停止时机器人所执行的喷涂指令放到一个子程序段中;进一步,在每个子程序段中,将其中使用工具坐标系Ft1的喷涂指令作为上半段,将其中使用工具坐标系Ft2的喷涂指令作为下半段,且在这上、下半段中间插入一个输出控制信号指令,用来控制喷枪装置中摆动气缸的动作,以获得正确的工具坐标系;最后按照csv文件或bin文件格式保存此喷涂程序,所输出的喷涂程序可直接发送或者拷贝到喷涂机器人的运动控制器中运行;
b、对于第七轴模式,在每条机器人喷涂指令中,除了记录常规的信息之外,还需要记录其线性附加轴的坐标;整个喷涂程序同样分为一系列的子程序段,将工件在长度方向上分段,喷涂每个工件子段的喷涂指令集合即为一个子程序段;每个子程序段的结构与输送线模式完全相同,其中对摆动气缸的控制也完全相同;最后同样以csv文件或者bin文件保存整个喷涂程序。
以上显示和描述了本发明的基本原理、主要特征和本发明的优点。本行业的技术人员应该了解,本发明不受上述实施例的限制,上述实施例和说明书中描述的只是本发明的原理,在不脱离本发明精神和范围的前提下,本发明还会有各种变化和改进,这些变化和改进都落入要求保护的本发明范围内。本发明要求保护范围由所附的权利要求书及其等效物界定。

Claims (9)

1.一种钢结构机器人喷涂自动路径规划方法,其具体步骤如下:
A、模式选择:选择喷涂系统的布置模式为输送线模式或者第七轴模式;
B、建立坐标系并导入机器人模型、工件模型及设定参数;
C、生成用于碰撞检测的网格模型;
D、生成几何基元列表并转换为喷涂基元列表;
E、对各喷涂基元进行路径规划,生成工件的完整喷涂路径;
F、机器人关节臂运动规划:根据喷涂路径以及机器人工作速度和加速度信息,给出机器人六个关节臂的速度曲线和加速度曲线;
G、检查关节臂的速度和加速度是否超限:检查机器人关节空间的速度、加速度是否超限,若超限则计算出超限因子,并据此减小笛卡尔移动速度和加速度、旋转速度和加速度;
H、细节路径规划并生成喷涂程序:根据高度值height与喷涂间距参数interval之间的相对大小关系,进行细节路径规划并按照制定的规范自动生成最终的喷涂程序,整个规划过程结束。
2.根据权利要求1所述的一种钢结构机器人喷涂自动路径规划方法,其特征在于:所述步骤A的输送线模式,由输送线带着工件移动来实现工件整体与机器人之间的平移运动;
所述步骤A的第七轴模式,由线性附加轴带着机器人移动来实现工件整体与机器人之间的平移运动。
3.根据权利要求1所述的一种钢结构机器人喷涂自动路径规划方法,其特征在于:所述步骤B中设定参数的第一部分是机器人工作参数;
第二部分是其它设备的工作参数;
第三部分是路径规划相关参数;
第四部分是程序生成相关参数。
4.根据权利要求1所述的一种钢结构机器人喷涂自动路径规划方法,其特征在于:所述步骤D中将几何基元转换为喷涂基元的处理操作,包括对梯形类几何基元的处理:依据梯形分割准则,将其转换为相应类型的喷涂基元。
5.根据权利要求1所述的一种钢结构机器人喷涂自动路径规划方法,其特征在于:所述步骤D中将几何基元转换为喷涂基元的处理操作,包括对平行四边形类几何基元的处理:依据最小基元阈值和线-面阈值参数,将其转换为相应类型的喷涂基元。
6.根据权利要求1所述的一种钢结构机器人喷涂自动路径规划方法,其特征在于:所述步骤D中将几何基元转换为喷涂基元的处理操作,包括对公共区域的处理:依据公共区域识别及其宽度阈值参数,将属于公共区域的几何基元转换为相应类型的喷涂基元,并分配给对应的机器人。
7.根据权利要求1所述的一种钢结构机器人喷涂自动路径规划方法,其特征在于:所述步骤D中将几何基元转换为喷涂基元的处理操作,包括对锐边邻接区域的处理:依据锐边识别及靠近锐边部分宽度参数,将锐边邻接区域转换为相应类型的喷涂基元。
8.根据权利要求1所述的一种钢结构机器人喷涂自动路径规划方法,其特征在于:所述步骤D中将几何基元转换为喷涂基元的处理操作,包括基于偏移量的修正处理:依据偏移量参数,对梯形类、平行四边形类几何基元进行修正处理,以控制其喷涂效果。
9.根据权利要求1所述的一种钢结构机器人喷涂自动路径规划方法,其特征在于:所述步骤E中的步骤为a、为分段长度或者位移百分比选择初值,所述初值通常取最大值;
b、选取喷枪角度初值,通常初选0°,通过函数R2E()将选定的喷枪角度转换为三个欧拉角,即姿态坐标,并获得对应的工件整体位移坐标或第七轴位移坐标;
c、根据路径点位姿坐标,使用空间解析几何方法和机器人逆运动学算法,计算出机器人关节空间的六维坐标(J1,J2,J3,J4,J5,J6);
d、关节角度超限检测:检查(J1,J2,J3,J4,J5)是否超出步骤B中设定的限制区间,若J1~J5超限,则首先尝试跳到步骤b中为喷枪角度选取新值,若已超出喷枪角度的取值范围则跳到步骤a中为分段长度或者位移百分比选取新值;若J1~J5没超限,则直接执行下一步;
e、笛卡尔空间z向超限检测:检查此时的机器人第六轴末端点的z坐标z6是否超出设定的限制区间并进行调整;
f、绕管检测:检查J6是否超出步骤B中设定的限制区间,如超限则根据J6与限制区间的关系添加过渡点;
g、碰撞检测:依据枪尖点和第六轴末端点的位姿坐标检查是否发生碰撞;如果有碰撞现象则根据碰撞发生时工件与喷枪之间的相对位置姿态关系,在喷涂路径中添加两个避让点。
CN201910222560.4A 2019-03-22 2019-03-22 一种钢结构机器人喷涂自动路径规划方法 Active CN109876968B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910222560.4A CN109876968B (zh) 2019-03-22 2019-03-22 一种钢结构机器人喷涂自动路径规划方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910222560.4A CN109876968B (zh) 2019-03-22 2019-03-22 一种钢结构机器人喷涂自动路径规划方法

Publications (2)

Publication Number Publication Date
CN109876968A true CN109876968A (zh) 2019-06-14
CN109876968B CN109876968B (zh) 2021-11-12

Family

ID=66933781

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910222560.4A Active CN109876968B (zh) 2019-03-22 2019-03-22 一种钢结构机器人喷涂自动路径规划方法

Country Status (1)

Country Link
CN (1) CN109876968B (zh)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110269323A (zh) * 2019-07-17 2019-09-24 东莞特雷斯智能科技有限公司 一种用于鞋底轨迹识别的涂胶系统
CN110639732A (zh) * 2019-10-08 2020-01-03 中集车辆(集团)股份有限公司 粉体涂装系统及粉体涂装方法
CN111451056A (zh) * 2020-04-24 2020-07-28 惠州市东一钢结构有限公司 一种钢结构自动喷涂设备
WO2021214636A1 (en) * 2020-04-23 2021-10-28 Shanghai Flexiv Robotics Technology Co., Ltd. Goal-oriented control of a robotic arm

Citations (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1038640A2 (en) * 1999-03-25 2000-09-27 Fanuc Ltd. Robot controller
KR100714904B1 (ko) * 2006-05-18 2007-05-04 곽문규 소형물체의 도장을 위한 도장로봇 구조체 및 도장 시스템
CN102046300A (zh) * 2008-06-05 2011-05-04 杜尔系统有限责任公司 紧凑的涂装室及方法
CN102831306A (zh) * 2012-08-13 2012-12-19 东南大学 一种用于喷涂机器人的分层喷涂轨迹规划方法
CN103400016A (zh) * 2013-08-15 2013-11-20 东南大学 一种针对小批量结构化工件的快速喷涂路径生成方法
CN103394430A (zh) * 2013-08-15 2013-11-20 东南大学 一种基于片间盲区优化工艺的复杂曲面均匀喷涂制造方法
CN103495516A (zh) * 2013-09-24 2014-01-08 盐城工学院 一种复杂曲面两遍自动喷涂轨迹优化方法
CN103909031A (zh) * 2014-04-09 2014-07-09 盐城工学院 一种曲面物体犄角识别喷涂方法
CN104777838A (zh) * 2015-04-15 2015-07-15 盐城工学院 一种犄角特征曲面连续变倾角喷涂轨迹规划方法
CN106362897A (zh) * 2016-11-23 2017-02-01 清华大学 一种自动化喷涂系统集成喷涂工艺的喷涂路径规划算法
CN106774165A (zh) * 2017-01-22 2017-05-31 广东工业大学 一种喷涂机器人加工工件的方法以及系统
CN107983570A (zh) * 2017-12-31 2018-05-04 芜湖哈特机器人产业技术研究院有限公司 一种基于三维视觉技术的钢构件喷涂系统
CN108789426A (zh) * 2017-12-29 2018-11-13 金门工程建设有限公司 表面处理机械人
CN109213069A (zh) * 2018-09-04 2019-01-15 同济大学 一种折弯类钣金零件机器人喷涂路径规划方法

Patent Citations (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1038640A2 (en) * 1999-03-25 2000-09-27 Fanuc Ltd. Robot controller
KR100714904B1 (ko) * 2006-05-18 2007-05-04 곽문규 소형물체의 도장을 위한 도장로봇 구조체 및 도장 시스템
CN102046300A (zh) * 2008-06-05 2011-05-04 杜尔系统有限责任公司 紧凑的涂装室及方法
CN102831306A (zh) * 2012-08-13 2012-12-19 东南大学 一种用于喷涂机器人的分层喷涂轨迹规划方法
CN103400016A (zh) * 2013-08-15 2013-11-20 东南大学 一种针对小批量结构化工件的快速喷涂路径生成方法
CN103394430A (zh) * 2013-08-15 2013-11-20 东南大学 一种基于片间盲区优化工艺的复杂曲面均匀喷涂制造方法
CN103495516A (zh) * 2013-09-24 2014-01-08 盐城工学院 一种复杂曲面两遍自动喷涂轨迹优化方法
CN103909031A (zh) * 2014-04-09 2014-07-09 盐城工学院 一种曲面物体犄角识别喷涂方法
CN104777838A (zh) * 2015-04-15 2015-07-15 盐城工学院 一种犄角特征曲面连续变倾角喷涂轨迹规划方法
CN106362897A (zh) * 2016-11-23 2017-02-01 清华大学 一种自动化喷涂系统集成喷涂工艺的喷涂路径规划算法
CN106774165A (zh) * 2017-01-22 2017-05-31 广东工业大学 一种喷涂机器人加工工件的方法以及系统
CN108789426A (zh) * 2017-12-29 2018-11-13 金门工程建设有限公司 表面处理机械人
CN107983570A (zh) * 2017-12-31 2018-05-04 芜湖哈特机器人产业技术研究院有限公司 一种基于三维视觉技术的钢构件喷涂系统
CN109213069A (zh) * 2018-09-04 2019-01-15 同济大学 一种折弯类钣金零件机器人喷涂路径规划方法

Non-Patent Citations (7)

* Cited by examiner, † Cited by third party
Title
刁训娣等: "喷漆机器人喷枪轨迹设计及影响因素研究 ", 《机械科学与技术》 *
帅佳慧: "六自由度喷涂机器人离线轨迹规划与仿真", 《中国优秀硕士学位论文全文数据库信息科技辑》 *
徐龙: ""面向喷涂作业的多机器人在线智能编程系统研究",徐龙,中国优秀硕士学位论文全文数据库信息科技辑,2018年第4期,D49-76页", 《中国优秀硕士学位论文全文数据库信息科技辑》 *
王刚: "工业机器人离线编程技术在喷涂领域应用研究", 《中国优秀硕士学位论文全文数据库信息科技辑》 *
郭洪红: "《工业机器人技术》", 31 March 2012, 西安电子科技大学出版社 *
陈伟著: "《A7喷涂机器人轨迹优化技术研究》", 31 October 2016, 中山大学出版社 *
陈雁,王国磊,陈恳著: "《复杂曲管机器人喷涂理论与技术》", 30 September 2016, 重庆大学出版社 *

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110269323A (zh) * 2019-07-17 2019-09-24 东莞特雷斯智能科技有限公司 一种用于鞋底轨迹识别的涂胶系统
CN110639732A (zh) * 2019-10-08 2020-01-03 中集车辆(集团)股份有限公司 粉体涂装系统及粉体涂装方法
CN110639732B (zh) * 2019-10-08 2021-06-25 中集车辆(集团)股份有限公司 粉体涂装系统及粉体涂装方法
WO2021214636A1 (en) * 2020-04-23 2021-10-28 Shanghai Flexiv Robotics Technology Co., Ltd. Goal-oriented control of a robotic arm
CN111451056A (zh) * 2020-04-24 2020-07-28 惠州市东一钢结构有限公司 一种钢结构自动喷涂设备

Also Published As

Publication number Publication date
CN109876968B (zh) 2021-11-12

Similar Documents

Publication Publication Date Title
CN109876968A (zh) 一种钢结构机器人喷涂自动路径规划方法
CN106826829B (zh) 一种可控误差的工业机器人光顺运动轨迹生成方法
CN102581444B (zh) 一种用于“j”型坡口焊接机器人的在线示教方法
CN104331542A (zh) 一种大型自由曲面的喷涂机器人站位规划方法
CN108508846B (zh) 一种曲面喷涂轨迹规划方法
CN102069267A (zh) 一种针对圆柱体相贯线焊缝的通用弧焊机器人示教方法
CN108582071A (zh) 一种工业机器人编程轨迹诊断及速度优化的方法
CN109986564A (zh) 工业机械臂路径规划方法
CN107457781A (zh) 一种控制机器人运动的方法和系统
Zhang et al. Double NURBS trajectory generation and synchronous interpolation for five-axis machining based on dual quaternion algorithm
Liu et al. Weld seam fitting and welding torch trajectory planning based on NURBS in intersecting curve welding
Zhou et al. Off-line programming system of industrial robot for spraying manufacturing optimization
Wei et al. Tool trajectory optimization of robotic spray painting
Wang et al. Design and implementation of five-axis transformation function in CNC system
CN108153707A (zh) 一种基于空间变换原理的弧焊机器人直线摆焊方法
Chen et al. Trajectory optimization of spray painting robot for complex curved surface based on exponential mean Bézier method
Bo et al. Fast and templatable path planning of spray painting robots for regular surfaces
Liu et al. Optimal path planning for automated dimensional inspection of free-form surfaces
CN109676603A (zh) 一种柔性超冗余度机器人控制方法
Yu et al. A robotic spraying path generation algorithm for free-form surface based on constant coating overlapping width
Zhang et al. Modeling and workspace analysis of collaborative advanced fiber placement machine
CN110802600A (zh) 一种六自由度关节型机器人的奇异性处理方法
Zhou et al. Path Planning for Spray Painting Robot of Horns Surfaces in Ship Manufacturing
Shen et al. An image-based algorithm for generating smooth and interference-free five-axis sweep scanning path
Gian et al. Planning of tool orientation for five-axis cavity machining.

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