CN113807488B - 贴标机器人***部件空间位置优化方法 - Google Patents
贴标机器人***部件空间位置优化方法 Download PDFInfo
- Publication number
- CN113807488B CN113807488B CN202111170205.0A CN202111170205A CN113807488B CN 113807488 B CN113807488 B CN 113807488B CN 202111170205 A CN202111170205 A CN 202111170205A CN 113807488 B CN113807488 B CN 113807488B
- Authority
- CN
- China
- Prior art keywords
- labeling
- robot
- industrial robot
- label printer
- robot system
- 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
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06N—COMPUTING ARRANGEMENTS BASED ON SPECIFIC COMPUTATIONAL MODELS
- G06N3/00—Computing arrangements based on biological models
- G06N3/004—Artificial life, i.e. computing arrangements simulating life
- G06N3/006—Artificial life, i.e. computing arrangements simulating life based on simulated virtual individual or collective life forms, e.g. social simulations or particle swarm optimisation [PSO]
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/16—Matrix or vector computation, e.g. matrix-matrix or matrix-vector multiplication, matrix factorization
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Mathematical Physics (AREA)
- General Physics & Mathematics (AREA)
- Data Mining & Analysis (AREA)
- Computational Mathematics (AREA)
- General Engineering & Computer Science (AREA)
- Pure & Applied Mathematics (AREA)
- Mathematical Optimization (AREA)
- Mathematical Analysis (AREA)
- Software Systems (AREA)
- Computing Systems (AREA)
- Molecular Biology (AREA)
- Biomedical Technology (AREA)
- Artificial Intelligence (AREA)
- Computational Linguistics (AREA)
- Life Sciences & Earth Sciences (AREA)
- Health & Medical Sciences (AREA)
- General Health & Medical Sciences (AREA)
- Evolutionary Computation (AREA)
- Biophysics (AREA)
- Algebra (AREA)
- Databases & Information Systems (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
贴标机器人***部件空间位置优化方法,采用的贴标机器人***,包括供压单元(1)、控制单元(2)、视觉单元(3)、标签打印机(4)和工业机器人(5),方法步骤:第1步,建立贴标机器人***的坐标系;第2步,生成贴标点的空间坐标;第3步,建立贴标机器人***中工业机器人和标签打印机空间位置优化的数学模型;第4步,采用优化算法完成计算。该方法建立贴标机器人***中标签打印机和工业机器人空间位置优化数学模型,根据贴标对象的约束条件,随机产生若干个空间点模拟多个贴标点的空间位置,应用非线性变化的惯性权重、学习因子和粒子数目实现粒子群优化算法的改进,***部件空间位置优化后提高了贴标机器人***的工作效率。
Description
技术领域
本发明涉及一种***部件空间位置优化方法,尤其是涉及一种贴标机器人***中工业机器人和标签打印机的空间位置优化方法,属于工业机器人技术领域。
背景技术
随着社会的快速发展,通过身份信息标签实现产品信息追溯已经变得越来越重要。目前自动贴标机的市场已经得到快速的发展,但是大部分的贴标机很难实现贴标位置不固定并且需要在线实时制备标签的工业场景,部分企业将机器视觉与机器人技术结合建立贴标机器人***,然而该***中标签打印机和工业机器人的空间位置关系十分重要,如果摆放的位置不合理将会影响贴标机器人***的工作效率及质量。本发明提出一种贴标机器人***部件空间位置优化方法,为贴标机器人***建立提供技术基础。
发明内容
基于以上原因,本发明提出一种贴标机器人***中的标签打印机和工业机器人的空间位置优化方法,以提高贴标机器人***的工作效率。
本发明贴标机器人***部件空间位置优化方法包括如下步骤:
第1步,建立贴标机器人***的坐标系,在待贴标工位的理论中心建立用户坐标系,根据用户坐标系的位姿确定工业机器人和标签打印机的姿态,建立工业机器人坐标系和标签打印机坐标系;
第2步,生成贴标点的空间坐标,根据贴标对象的约束条件,随机产生若干个空间点模拟多个贴标点的空间位置;
第3步,建立贴标机器人***中工业机器人和标签打印机空间位置优化的数学模型,以工业机器人空间位置和标签打印机空间位置为设计变量,结合机器人的工作空间确定工业机器人和标签打印机的空间位置约束条件,将工业机器人的关节转角总行程最小作为目标函数,利用工业机器人逆运动学解析解表达式将取标点和所有贴标点的世界坐标位姿矩阵转化为机器人关节坐标,计算机器人从取标点运动到单个贴标点的各关节转角改变量的绝对值之和为单个贴标点的关节转角行程,对所有贴标点的关节转角行程求和得到工业机器人的关节转角总行程;
第4步,采用优化算法完成计算,采用优化算法求解贴标机器人***中工业机器人和标签打印机空间位置优化的数学模型,得到工业机器人完成所有贴标点贴标关节转角总行程最小的工业机器人和标签打印机摆放的最佳空间位置。
本发明采用改进的粒子群优化算法完成贴标机器人***部件空间位置优化的计算,对传统的粒子群优化算法进行如下改进:
(1)以非线性变化的Tanh函数计算惯性权重ω,计算公式为式中,ωmin、ωmax代表惯性权重的最小值和惯性权重的最大值,K为最大迭代次数,k为当前迭代次数,λ为放大系数,μ为平移系数;
(2)采用异步非线性变化的学习因子,个体学习因子c1的计算公式为式中,c1max、c1min为最大个体学习因子和最小个体学习因子;社会学习因子c2的计算公式为/>式中,c2max、c2min为最大社会学习因子和最小社会学习因子;
(3)采用非线性变化的粒子数目n,计算公式为式中,nmax为迭代最大粒子数;nmin为迭代最小粒子数。
采用改进的粒子群优化算法完成贴标机器人***部件空间位置优化计算的具体步骤如下:
①初始化贴标机器人***优化数学模型基本参数,随机初始化贴标点中心坐标和所有粒子的位置和速度,初始化个体最优值,取最小值为全局最优值;
②更新非线性变化的粒子数目;
③更新异步非线性变化的学习因子和以Tanh函数计算非线性变化的惯性权重,更新所有粒子的位置和速度,根据工业机器人运动学解析解,计算工业机器人的关节转角总行程,更新所有粒子适应度值,更新全局最优值和个体最优值;
④判断迭代是否达到最大的迭代次数,若没有则返回步骤②。
本发明方法的有益效果:
(1)通过建立贴标机器人***部件空间位置优化的数学模型,采用优化算法求解贴标机器人***中标签打印机和工业机器人最优空间位置,提高贴标机器人***的工作效率;
(2)根据贴标对象的约束条件,随机产生若干个空间点模拟多个贴标点的空间位置;
(3)应用非线性变化的惯性权重、学习因子和粒子数目实现粒子群优化算法的改进,提高算法的收敛精度和优化效率。
附图说明
图1是本发明方法采用的贴标机器人***的结构示意图;
图2是本发明方法采用的贴标机器人***的坐标系;
图3是本发明改进的粒子群优化算法的流程图。
具体实施方式
本发明贴标机器人***部件空间位置优化方法包括如下步骤:
第1步,建立贴标机器人***的坐标系,在待贴标工位的理论中心建立用户坐标系,根据用户坐标系的位姿确定工业机器人和标签打印机的姿态,建立工业机器人坐标系和标签打印机坐标系;
第2步,生成贴标点的空间坐标,根据贴标对象的约束条件,随机产生若干个空间点模拟多个贴标点的空间位置;
第3步,建立贴标机器人***中工业机器人和标签打印机空间位置优化的数学模型,以工业机器人空间位置和标签打印机空间位置为设计变量,结合机器人的工作空间确定工业机器人和标签打印机的空间位置约束条件,将工业机器人的关节转角总行程最小作为目标函数,利用工业机器人逆运动学解析解表达式将取标点和所有贴标点的世界坐标位姿矩阵转化为机器人关节坐标,计算机器人从取标点运动到单个贴标点的各关节转角改变量的绝对值之和为单个贴标点的关节转角行程,对所有贴标点的关节转角行程求和得到工业机器人的关节转角总行程;
第4步,采用优化算法完成计算,采用优化算法求解贴标机器人***中工业机器人和标签打印机空间位置优化的数学模型,得到工业机器人完成所有贴标点贴标关节转角总行程最小的工业机器人和标签打印机摆放的最佳空间位置。
本发明采用改进的粒子群优化算法完成贴标机器人***部件空间位置优化的计算,对传统的粒子群优化算法进行如下改进:
(1)以非线性变化的Tanh函数计算惯性权重ω,计算公式为式中,ωmin、ωmax代表惯性权重的最小值和惯性权重的最大值,K为最大迭代次数,k为当前迭代次数,λ为放大系数,μ为平移系数;
(2)采用异步非线性变化的学习因子,个体学习因子c1的计算公式为式中,c1max、c1min为最大个体学习因子和最小个体学习因子;社会学习因子c2的计算公式为/>式中,c2max、c2min为最大社会学习因子和最小社会学习因子;
(3)采用非线性变化的粒子数目n,计算公式为式中,nmax为迭代最大粒子数;nmin为迭代最小粒子数。
采用改进的粒子群优化算法完成贴标机器人***部件空间位置优化计算的具体步骤如下:
①初始化贴标机器人***优化数学模型基本参数,随机初始化贴标点中心坐标和所有粒子的位置和速度,初始化个体最优值,取最小值为全局最优值;
②更新非线性变化的粒子数目;
③更新异步非线性变化的学习因子和以Tanh函数计算非线性变化的惯性权重,更新所有粒子的位置和速度,根据工业机器人运动学解析解,计算工业机器人的关节转角总行程,更新所有粒子适应度值,更新全局最优值和个体最优值;
④判断迭代是否达到最大的迭代次数,若没有则返回步骤②。
本发明适用于图1所示的贴标机器人***,包括供压单元1、控制单元2、视觉单元3、标签打印机4和工业机器人5。使用贴标机器人***对特钢棒材精整生产线成捆棒材称重工位的成捆棒材端面进行贴标操作,采用本发明方法对***中的工业机器人和标签打印机的空间位置进行优化。
1建立贴标机器人***的坐标系
贴标机器人***的坐标系如图2所示。贴标机器人***的标签打印机选用斑马公司的 ZT410型打印剥离一体工业打印机,工业机器人选用埃夫特公司的ER7L-C10型六自由度工业机器人。以成捆棒材整体端面的理论平面作为Xw-Yw平面。由于一捆棒材最大直径不超过 360mm,成捆棒材支架水平放置,以成捆棒材最大直径中心为原点Ow,以水平向右为Xw正方向,以竖直向上为Yw正方向,建立用户坐标系。以工业机器人固定底座法兰盘中心为原点 O0,工业机器人坐标系的X0轴与用户坐标系的Xw轴方向一致,工业机器人坐标系的Z0轴与用户坐标系的Yw轴方向一致,建立工业机器人坐标系。以标签打印机打印的标签中心点为原点Op,标签打印机坐标系的Xp轴与工业机器人坐标系的X0轴方向一致,标签打印机坐标系的Zp轴与工业机器人坐标系的Z0轴方向一致。
2建立成捆棒材中每根棒材中心坐标
工业现场成捆棒材端面最大不平齐度20mm,成捆棒材最大捆直径360mm,在此约束条件下确定棒材中心坐标Pb=[xb,yb,zb]T在用户坐标系下的范围为:-160mm<xb<160mm, -160mm<yb<160mm,-20mm<zb<0mm。为了保证工业机器人和标签打印机摆放位置固定后,成捆棒材中每根棒材贴标点在工业机器人工作空间内,通过蒙特卡洛法随机产生空间点模拟棒材中心坐标,在MATLAB环境下通过利用unifrnd函数随机产生N=2000个空间点模拟棒材中心坐标:
steel_center(:,1)=unifrnd(-160,160,[1,N]);
steel_center(:,2)=unifrnd(-160,160,[1,N]);
steel_center(:,3)=unifrnd(0,0,[1,N])。
3建立贴标机器人***中工业机器人和标签打印机空间位置优化的数学模型
贴标机器人***中视觉单元布置在棒材正前方。为了避免遮挡相机视野,这里工业机器人放在棒材左侧,标签打印机放置在工业机器人右侧。工业机器人的末端操作器长300mm、压缩总行程为50mm。为了保证设备的安全,在用户坐标系Zw轴340mm处ER7L-C10工业机器人通过直线运动贴标,末端操作器压缩行程40mm,贴标时工业机器人直线运动距离为80mm。ER7L-C10工业机器人最大工作半径910mm,为了保证成捆棒材和标签打印机在机器人的工作空间内,综合考虑工业机器人结构和工作方式,限定工业机器人空间位置Pr=[x1,y1,z1]T在用户坐标系下的范围为:-620mm<x1<-200mm,-640mm<y1<-200mm, 200mm<z1<700mm;标签打印机空间位置Pp=[x2,y2,z2]T在工业机器人坐标系下的范围为: 600mm<x2<1000mm,-400mm<y2<400mm,0mm<z2<600mm。
工业机器人贴标时,末端操作器的轴向垂直棒材端面,工业机器人取标时末端操作器的轴向垂直标签表面,通过试验确定机器人运动到贴标点的工业机器人世界坐标位姿矩阵Tp为:
取标点的工业机器人世界坐标位姿矩阵Tt为:
ER7L-C10工业机器人正运动学分析,根据ER7L-C10机器人厂家提供的机器人连杆信息,机器人连杆转角θ1=0°,θ2=90°,θ3=0°,θ4=0°,θ5=0°,θ6=0°,确定其机器人D-H参数如表 1所示。
表1机器人D-H参数
标准D-H参数法的ER7L-C10工业机器人相邻两个坐标系之间的齐次变换矩阵通式An为:
式中,sn表示sinθn,cn表示cosθn,s23表示sin(θ2+θ3),c23表示cos(θ2+θ3),根据D-H参数,求得A0-A6变换矩阵为:
将齐次变换矩阵A1-A6连乘得到ER7L-C10工业机器人从基座到TCP的齐次变换矩阵T6为:
式中,
nx=s1c4s6-c1s4s6c23+s1s4c5c6+c1c4c5c6c23-c1s5c6s23;
ny=-c1c4s6-s1s4s6c23-c1s4c5c6+s1c4c5c6c23-s1s5c6s23;
nz=s5c6c23+c4c5c6s23-s4s6s23;
ox=s1c4c6-c1s4c6c23-s1s4c5s6-c1c4c5s6c23+c1s5s6s23;
oy=s6c1s4c5-s1c4c5s6c23+s1s5s6s23-c1c4c6-s1s4c6c23;
oz=-s5s6c23-c4c5s6s23-s4c6s23;
ax=s1s4s5+c1c4s5c23+c1c5s23;
ay=s1c5s23-c1s4s5+s1c4s5c23;
az=c4s5s23-c23c5;
px=d3s1+a1c1+d4c1s23+a2c1c2+d6c1c5s23+a3c1c23+d6c1c5c23+d6s1s4s5+d6c1c4s5c23;
py=a1s1-d3c1+d4s1s23+a2s1c2+d6s1c5s23-d6c1s4s5+a3s1s23+d6s1c4s5c23;
pz=d1-d4c23+a3s23+a2s2-d6c5c23+d6c4s5s23。
在MATLAB环境下,根据计算出的正运动解析解,编写工业机器人正运动学ER7L_C10_zhengjie.m函数。
ER7L-C10工业机器人逆运动学分析,应用解析法中的分离变量法实现机器人逆运动学的解析解求解,根据机器人ER7L-C10的结构特性,θ5为零时,需要分情况讨论关节角θ4和θ6解的情况,因此先求解关节角θ1、θ2、θ3,再求解关节角θ4、θ5、θ6。
由ER7L-C10工业机器人齐次变换矩阵T6左乘矩阵A1 -1,右乘矩阵A6 -1可得:
根据上式求解关节角θ1、θ2、θ3为:
θ3=θ23-θ2 (6)
式中:
m2=pz-d1-azd6;m1=pxc1-a1+pys1-ayd6s1-axd6c1;
m3=(d4 2+a3 2+m1 2+m2 2-a2 2)/2;
由ER7L-C10工业机器人齐次变换矩阵T6左乘矩阵A1 -1,左乘矩阵A2 -1,左乘矩阵A3 -1可得:
当θ5不等于0时,根据上式求解关节角θ4、θ5、θ6为:
θ5=±arccos(s23(axc1+ays1)-azc23) (8)
由ER7L-C10工业机器人齐次变换矩阵T6左乘矩阵A1 -1,可得:
当θ5等于0时,θ46表示θ4+θ6,根据上式求解关节角θ46为:
由于机器人关节角θ5等于0时,机器人4、5、6轴同轴,此时机器人处于奇异点,θ4与θ6有无穷多解,因此这里求解θ4与θ6关节角和,通过角度θ46求关节角θ4与θ6,θ4与θ6求解有三种选解方法,
(1)读取ER7L-C10工业机器人6轴当前角度值为关节角θ6的值,则θ4的值为θ46-θ6;
(2)读取ER7L-C10工业机器人4轴当前角度值为关节角θ4的值,则θ6的值为θ46-θ4;
(3)人为给定关节角θ4的值,求解θ6的值;或者给定关节角θ6的值,求解θ4的值。
综上所述,ER7L_C10工业机器人θ1,θ2,θ3,θ4,θ5,θ6的可行解全部求出,将逆运动学解析解组合排列共有16种可能解,根据“最小行程法”规则实现逆解选解。关节角θ5等于0机器人奇异时,通过方式一选解。在MATLAB环境下,编写工业机器人逆运动学 ER7L_C10_fanjie.m和ER7L_C10_readmessage.m函数。
成捆棒材贴标时机器人各关节转角总行程最小原则实现空间位置优化。利用工业机器人逆运动学解析解表达式将取标点和所有贴标点的世界坐标位姿矩阵转化为机器人关节坐标,计算出机器人从取标点运动到贴标点的各关节转角改变量,对各关节转角改变量取绝对值求和即为每根棒材贴标过程的关节转角总行程,工业机器人的关节转角总行程为成捆棒材中每根棒材的关节转角总行程的和,利用优化算法求解工业机器人的关节转角总行程的最小值,优化设计的数学模型为:
式中,f为所有粒子最小适应度值;N表示一捆棒材根数;θ1j贴标点各关节转角;θ2j取标点各关节转角,j=1,2,…,6;i=1,2,…,N。
4采用改进的粒子群优化算法完成计算
应用优化对工业机器人和标签打印机的空间摆放位置优化,以改进的粒子群优化算法实现,传统粒子群优化算法中粒子的速度和位置是通过对比粒子的个体最优值和全局最优值实现更新。
式中,ω为惯性权重,k为当前迭代次数;id=1,2,…,n;c1、c2为个体学习因子和社会学习因子;r1、r2为[0-1]范围内随机数;pid k为个体最优值;gid k为全局最优值;vid k为粒子id在第 k次迭代的飞行速度;Xid k为粒子id在第k次迭代的位置。
对传统的粒子群算法各参数改进如下:
(1)非线性动态调节惯性权重
惯性权重ω的大小对于粒子群搜索全局最优解有很大的影响。提出采用Tanh函数,作为惯性权重计算公式。在算法开始执行的时候,通过对ω赋予较大的值,可以使算法在迭代的初期能够以较大的速度在约束条件内进行较好的搜索,使得算法能够以较大的概率向着全局最优解进行收敛,随着算法的执行,对ω逐渐的减小,这样可以使得优化问题的解在全局最优和局部最优之间进行权衡,以得到最优适应度值。
式中,ωmin、ωmax代表惯性权重的最小值和最大值;K为迭代总数;λ为放大系数;μ为平移系数。
(2)异步变化学习因子调节
个体学习因子c1和社会学习因子c2控制粒子向着个体和全局最优解移动,应用动态变化的学习因子可以提高优化算法计算效率,可以极大的避免算法计算结果陷入局部最优。引入三角函数作为异步非线性变化的学习因子。通过在算法前期应用较大的个体学习因子和较小的社会学习因子,这可以使算法充分搜索粒子周围的解,在算法优化的后期应用较小的个体学习因子,较大的社会学习因子,使粒子向全局最优解靠近。
式中,c1max、c1min为最大和最小个体学习因子;c2max、c2min为最大和最小社会学习因子。
(3)非线性递减的粒子数目
工业机器人和标签打印机的空间位置优化采用传统的粒子群算法优化耗时较长,因为采用蒙特卡洛法随机生成的2000根棒材需要较大的粒子数目实现粒子群迭代求解。每次迭代的粒子数目保持不变会导致较长时间的迭代计算,因此提出将粒子数目非线性递减。
式中,nmax为迭代最大粒子数;nmin为迭代最小粒子数。
迭代总数K=200,计算参数:式(16)中的参数,λ=8,μ=1,ωmin=0.4,ωmax=0.8;式(17) 中的参数,c1min=0.5,c1max=2.5;式(18)中的参数c2min=0.5,c2max=2.5;式(19)中的参数,nmax=150, nmin=50,μ=1.1。
提出的改进的粒子群优化算法通过式(16)、(17)、(18)、(19)实现惯性权重、学习因子和粒子数目的更新,求解工业机器人和标签打印机最优空间位置的改进的粒子群优化算法的流程图如图3所示。
在MATLAB环境下具体计算过程:
①初始化粒子群优化算法各参数变量值,初始化工业机器人和标签打印机空间位置约束范围,根据rand(nmax,1)函数随机初始化粒子的位置和速度;
变量个数:narvs=6;
社会学习因子最大值:c11=2.5;
社会学习因子最小值:c12=0.5;
个体学习因子最大值:c21=2.5;
个体学习因子最小值:c22=0.5;
惯性权重最大值:wmax=0.8;
惯性权重最小值:wmin=0.4;
迭代总数:K=200;
粒子的最大速度:vmax=15;
放大系数:lmd=8;
平移系数:dis_n=1.1;
迭代最大粒子数:nmax=150;
迭代最小粒子数:nmin=50;
工业机器人X坐标范围:
robot_x_max=-200;robot_x_min=-620;
工业机器人Y坐标范围:
robot_y_max=-200;robot_y_min=-640;
工业机器人Z坐标范围
robot_z_max=700;robot_z_min=200;
标签打印机X坐标范围
printer_x_max=1000;printer_x_min=600;
标签打印机Y坐标范围
printer_y_max=400;printer_y_min=-400;
标签打印机Z坐标范围
printer_z_max=600;printer_z_min=0;
初始化工业机器人和标签打印机的空间位置:
robot_x=robot_x_min+(robot_x_max-robot_x_min).*rand(nmax,1);
robot_y=robot_y_min+(robot_y_max-robot_y_min).*rand(nmax,1);
robot_z=robot_z_min+(robot_z_max-robot_z_min).*rand(nmax,1);
printer_x=printer_x_min+(printer_x_max-printer_x_min).*rand(nmax,1);
printer_y=printer_y_min+(printer_y_max-printer_y_min).*rand(nmax,1);
printer_z=printer_z_min+(printer_z_max-printer_z_min).*rand(nmax,1);
position_pso=[robot_x,robot_y,robot_z,printer_x,printer_y,printer_z];
初始化粒子的速度:
v=-vmax+2*vmax.*rand(nmax,narvs)。
根据工业机器人关节转角总行程计算函数Object_Function(steel_center,position_pso,ii)和单根棒材工业机器人从取标点运动到贴标点的计算函数AngleFunction(steel_x,steel_y,steel_z) 计算适应度fit(ii),初始化粒子群全局最优值gbest和个体最优值pbest:
pbest=position_pso;
ind=find(fit==min(fit),1);
gbest=position_pso(ind,:)。
初始化成捆棒材中每根棒材中心坐标steel_center:
steel_center(:,1)=unifrnd(-160,160,[1,N]);
steel_center(:,2)=unifrnd(-160,160,[1,N]);
steel_center(:,3)=unifrnd(0,0,[1,N])。
②根据式(19)更新粒子数目n;
n=round(nmin+(nmax-nmin)*(1-(exp(lmd*(2*d/K-dis_n))-exp(lmd*(-(2*d/K-dis_n))))/(exp(lm d*(2*d/K-dis_n))+exp(lmd*(-(2*d/K-dis_n)))))/2);
[fit,index]=sort(fit);
③根据式(14)、式(15)、式(16)、式(17)和式(18)更新粒子的速度、位置、惯性权重、和学习因子,根据函数Object_Function和AngleFunction更新适应度,更新全局最优值和个体最优值。
惯性权重更新:
w=wmin+(wmax-wmin)*(1-(exp(lmd*(2*d/K-1))-exp(lmd*(-(2*d/K-1))))/(exp(lmd*(2*d/K-1) )+exp(lmd*(-(2*d/K-1)))))/2。
个体学习因子更新:
c1=c12+(c11-c12)*cos((d/K)*pi/2)。
社会学习因子更新:
c2=c21-(c21-c22)*cos((d/K)*pi/2)。
速度更新:
v(i,:)=w*v(i,:)+c1*rand(1)*(pbest(index(i),:)-position_pso(index(i),:))+c2*rand(1)*(gbest-posit ion_pso(index(i),:))。
位置更新:
position_pso(index(i),:)=position_pso(index(i),:)+v(i,:)。
根据单根棒材工业机器人从取标点运动到贴标点的计算函数计算temp_sum:
temp_sum=temp_sum+AngleFunction(position(i,1),position(i,2),position(i,3))。
根据工业机器人关节转角总行程函数计算fit(index(i)):
fit(index(i))=Object_Function(steel_center,position_pso,index(i))。
第d次迭代最优适应度函数为:
fitnessbest(d)=Object_Function(steel_center,gbest,1)。
④通过K次迭代,执行步骤②和步骤③计算出工业机器人的关节转角总行程的最小值,得到工业机器人和标签打印机最优空间摆放位置,改进的粒子群优化算法的计算结果如表2 所示。
表2粒子群优化结果
/>
Claims (1)
1.贴标机器人***部件空间位置优化方法,所述方法采用的贴标机器人***,包括供压单元(1)、控制单元(2)、视觉单元(3)、标签打印机(4)和工业机器人(5),其特征在所述方法包括如下步骤:
第1步,建立贴标机器人***的坐标系,在待贴标工位的理论中心建立用户坐标系,根据用户坐标系的位姿确定工业机器人和标签打印机的姿态,建立工业机器人坐标系和标签打印机坐标系;
第2步,生成贴标点的空间坐标,根据贴标对象的约束条件,随机产生若干个空间点模拟多个贴标点的空间位置;
第3步,建立贴标机器人***中工业机器人和标签打印机空间位置优化的数学模型,以工业机器人空间位置Pr=[x 1,y 1,z 1]T和标签打印机空间位置P p=[x 2,y 2,z 2]T为设计变量,结合机器人的工作空间确定工业机器人和标签打印机的空间位置约束条件,将工业机器人的关节转角总行程最小作为目标函数,利用工业机器人逆运动学解析解表达式将取标点和所有贴标点的世界坐标位姿矩阵转化为机器人关节坐标,计算机器人从取标点运动到单个贴标点的各关节转角改变量的绝对值之和为单个贴标点的关节转角行程,对所有贴标点的关节转角行程求和得到工业机器人的关节转角总行程;
第4步,采用优化算法完成计算,采用优化算法求解贴标机器人***工业机器人和标签打印机空间位置优化的数学模型,得到工业机器人完成所有贴标点贴标关节转角总行程最小的工业机器人和标签打印机摆放的最佳空间位置,采用改进的粒子群优化算法完成贴标机器人***部件空间位置优化的计算,对传统的粒子群优化算法进行如下改进:
(1)以非线性变化的Tanh函数计算惯性权重ω,计算公式为,式中,ω min、ω max代表惯性权重的最小值和惯性权重的最大值,K为最大迭代次数,k为当前迭代次数,λ为放大系数,µ为平移系数;
(2)采用异步非线性变化的学习因子,个体学习因子c 1的计算公式为,式中,c 1max、c 1min为最大个体学习因子和最小个体学习因子;社会学习因子c 2的计算公式为/>,式中,c 2max、c 2min为最大社会学习因子和最小社会学习因子;
(3)采用非线性变化的粒子数目n,计算公式为,式中,n max为迭代最大粒子数;n min为迭代最小粒子数;
采用改进的粒子群优化算法完成贴标机器人***部件空间位置优化计算的具体步骤如下:
①初始化贴标机器人***优化数学模型基本参数,随机初始化贴标点中心坐标和所有粒子的位置和速度,初始化个体最优值,取最小值为全局最优值;
②更新非线性变化的粒子数目;
③更新异步非线性变化的学习因子和以Tanh函数计算非线性变化的惯性权重,更新所有粒子的位置和速度,根据工业机器人运动学解析解,计算工业机器人的关节转角总行程,更新所有粒子适应度值,更新全局最优值和个体最优值;
④判断迭代是否达到最大的迭代次数,若没有则返回步骤②。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111170205.0A CN113807488B (zh) | 2021-10-05 | 2021-10-05 | 贴标机器人***部件空间位置优化方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111170205.0A CN113807488B (zh) | 2021-10-05 | 2021-10-05 | 贴标机器人***部件空间位置优化方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113807488A CN113807488A (zh) | 2021-12-17 |
CN113807488B true CN113807488B (zh) | 2023-08-04 |
Family
ID=78939313
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111170205.0A Active CN113807488B (zh) | 2021-10-05 | 2021-10-05 | 贴标机器人***部件空间位置优化方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113807488B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114265364B (zh) * | 2021-12-21 | 2023-10-03 | 江苏师范大学 | 一种工业物联网的监测数据处理***及方法 |
CN117565031B (zh) * | 2023-09-13 | 2024-04-09 | 河北科技大学 | 基于平移与旋转解耦的双舵轮移动机器人运动学建模方法 |
CN117371606B (zh) * | 2023-10-30 | 2024-05-24 | 山西恒安达技术科技有限公司 | 一种打印数据分析方法及*** |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5017261A (en) * | 1988-04-09 | 1991-05-21 | Eti-Tec Maschinenbau Gmbh | Labelling machine for objects such as bottles or the like |
JP2000318251A (ja) * | 1999-05-07 | 2000-11-21 | King Jim Co Ltd | 見出し印刷システム及び方法並びに見出し印刷プログラムを記録したコンピュータ読み取り可能な記録媒体及びサンプルデータを記録したコンピュータ読み取り可能な記録媒体 |
RU2441830C1 (ru) * | 2010-09-22 | 2012-02-10 | Игорь Вадимович Барсук | Способ выгрузки штучных грузов из контейнера |
CN105883116A (zh) * | 2016-03-31 | 2016-08-24 | 河北科技大学 | 自动贴标***中机器人摆放位置的优化方法 |
CN108932216A (zh) * | 2018-06-22 | 2018-12-04 | 上海工程技术大学 | 一种基于粒子群优化算法的机器人逆运动学求解方法 |
CN109590983A (zh) * | 2017-09-30 | 2019-04-09 | 上海宝信软件股份有限公司 | 取样机器人及其使用方法 |
CN208897531U (zh) * | 2018-10-12 | 2019-05-24 | 西安中科光电精密工程有限公司 | 一种原单覆盖式在线打印贴标机器人 |
CA3060447A1 (en) * | 2019-10-28 | 2021-04-28 | Airbus Defence and Space GmbH | Sensor device, capture device, determination procedure and capture method for determining a relative position and capture of an object in space |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11720112B2 (en) * | 2019-09-17 | 2023-08-08 | JAR Scientific LLC | Autonomous object relocation robot |
-
2021
- 2021-10-05 CN CN202111170205.0A patent/CN113807488B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5017261A (en) * | 1988-04-09 | 1991-05-21 | Eti-Tec Maschinenbau Gmbh | Labelling machine for objects such as bottles or the like |
JP2000318251A (ja) * | 1999-05-07 | 2000-11-21 | King Jim Co Ltd | 見出し印刷システム及び方法並びに見出し印刷プログラムを記録したコンピュータ読み取り可能な記録媒体及びサンプルデータを記録したコンピュータ読み取り可能な記録媒体 |
RU2441830C1 (ru) * | 2010-09-22 | 2012-02-10 | Игорь Вадимович Барсук | Способ выгрузки штучных грузов из контейнера |
CN105883116A (zh) * | 2016-03-31 | 2016-08-24 | 河北科技大学 | 自动贴标***中机器人摆放位置的优化方法 |
CN109590983A (zh) * | 2017-09-30 | 2019-04-09 | 上海宝信软件股份有限公司 | 取样机器人及其使用方法 |
CN108932216A (zh) * | 2018-06-22 | 2018-12-04 | 上海工程技术大学 | 一种基于粒子群优化算法的机器人逆运动学求解方法 |
CN208897531U (zh) * | 2018-10-12 | 2019-05-24 | 西安中科光电精密工程有限公司 | 一种原单覆盖式在线打印贴标机器人 |
CA3060447A1 (en) * | 2019-10-28 | 2021-04-28 | Airbus Defence and Space GmbH | Sensor device, capture device, determination procedure and capture method for determining a relative position and capture of an object in space |
Non-Patent Citations (1)
Title |
---|
圆钢端面贴标机器人机构构型综合;张付祥 等;《制造技术与机床》;正文全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN113807488A (zh) | 2021-12-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113807488B (zh) | 贴标机器人***部件空间位置优化方法 | |
Dereli et al. | IW-PSO approach to the inverse kinematics problem solution of a 7-DOF serial robot manipulator | |
CN110238839B (zh) | 一种利用环境预测优化非模型机器人多轴孔装配控制方法 | |
CN109676610B (zh) | 一种断路器装配机器人及其实现工作轨迹优化的方法 | |
CN105159096A (zh) | 一种基于粒子群算法的冗余度空间机械臂关节力矩优化方法 | |
CN110695988A (zh) | 双机械臂协同运动方法及*** | |
Wang et al. | Robust adaptive visual tracking control for uncertain robotic systems with unknown dead-zone inputs | |
CN108153957A (zh) | 空间机械臂动力学仿真分析方法、***及存储介质 | |
CN111208730A (zh) | 一种快速终端滑模阻抗控制算法 | |
Guan et al. | Numerical methods for reachable space generation of humanoid robots | |
CN113043278A (zh) | 一种基于改进型鲸鱼搜索方法的机械臂轨迹规划方法 | |
CN111571584A (zh) | 一种成捆棒材机器人贴标路径规划及奇异性校验方法 | |
CN113434982B (zh) | 一种电力智能仿生攀爬机器人的运动学逆解方法 | |
CN116276990A (zh) | 基于神经网络训练的两自由度并联结构运动学正解方法 | |
He et al. | Optimal design of industrial robot kinematics algorithm | |
Qi et al. | Reinforcement learning control for robot arm grasping based on improved DDPG | |
CN115618574A (zh) | 一种用于水下机器人-机械臂***的Adams/Matlab联合仿真方法 | |
CN115519546A (zh) | 一种基于智能视觉的天地协同空间科学实验机器人 | |
CN111966040B (zh) | 一种机器人拾放任务中用于平衡冲击动载的轨迹生成方法 | |
Ge | Kinematics modeling of redundant manipulator based on screw theory and Newton-Raphson method | |
Li | A Design of Robot System for Rapidly Sorting Express Carton with Mechanical Arm Based on Computer Vision Technology | |
Wen et al. | Offline kinematics simulation of 6-DOF welding robot | |
Yue | Kinematic modelling and simulation of LeArm robot | |
Liang et al. | Research on the intelligent recognition system of printing roller surface defects based on machine vision | |
Yang et al. | Research on gravity compensation in motion control of multi-joint robot |
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 |