CN106516153B - 结合温度因素的飞机壁板卧式自动钻铆机空间相对位姿误差补偿方法 - Google Patents

结合温度因素的飞机壁板卧式自动钻铆机空间相对位姿误差补偿方法 Download PDF

Info

Publication number
CN106516153B
CN106516153B CN201610946457.0A CN201610946457A CN106516153B CN 106516153 B CN106516153 B CN 106516153B CN 201610946457 A CN201610946457 A CN 201610946457A CN 106516153 B CN106516153 B CN 106516153B
Authority
CN
China
Prior art keywords
relative pose
positioning device
grid
temperature
error
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
Application number
CN201610946457.0A
Other languages
English (en)
Other versions
CN106516153A (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.)
Zhejiang University ZJU
Original Assignee
Zhejiang University ZJU
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 Zhejiang University ZJU filed Critical Zhejiang University ZJU
Priority to CN201610946457.0A priority Critical patent/CN106516153B/zh
Publication of CN106516153A publication Critical patent/CN106516153A/zh
Application granted granted Critical
Publication of CN106516153B publication Critical patent/CN106516153B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Manipulator (AREA)

Abstract

本发明公开了一种结合温度因素的飞机壁板卧式自动钻铆机空间相对位姿误差补偿方法,具体为:分析飞机壁板卧式自动钻铆机中两定位设备的协同工作空间,并进行合理的网格划分;在不同温度下,激光跟踪仪通过跟踪测量两定位设备的实际相对位姿误差,构建一定温度区间内的空间相对位姿误差网格,并通过线性插值法和形函数插值法计算目标温度下协同工作空间网格内任意点的误差值;依照两定位设备的主从关系,采用通过从动定位设备进行两协同设备空间相对位姿误差补偿的策略,实现误差补偿;该方法快速有效地提高了多设备协同工作精度,提高飞机装配中的孔加工质量,进而提升飞机部件整体的装配质量与装配效率。

Description

结合温度因素的飞机壁板卧式自动钻铆机空间相对位姿误差 补偿方法
技术领域
本发明涉及飞机装配技术与装备领域,尤其涉及结合温度因素的飞机壁板卧式自动钻铆机空间相对位姿误差补偿方法。
背景技术
飞机装配作为飞机制造中极其重要的一环,在很大程度上决定了飞机的最终质量、制造成本和交货周期,是整个飞机制造过程中的关键和核心技术。由于飞机装配过程中涉及到大量的制孔和紧固件连接过程,因此,制孔与紧固件连接的质量和效率,将成为影响飞机整体装配质量和效率的重要因素。
该飞机壁板卧式自动钻铆机是飞机装配中重要的制孔与紧固件连接设备,能够自动完成飞机壁板中直径小于6mm的铆接孔的定位、制孔、锪窝、除尘、插钉、压铆等操作。它由制孔插钉侧机床和镦紧侧机床组成,两侧定位设备通过协同工作实现高质量自动化钻铆过程。结合飞机壁板铆接的质量要求可知,保证自动钻铆机中两定位设备末端的协调与相对位姿精度,是保证钻铆质量、提高整机装配质量所不可缺少的一部分。
在飞机壁板卧式自动钻铆机的复杂***中,影响设备整体的协调与工作精度的因素有很多。当单侧定位设备均满足精度要求时,由于几何误差、热误差和自重产生的变形等因素,两协同设备末端仍会存在相对位姿误差,导致制孔偏斜、插钉和铆接过程不协调等严重问题,严重影响设备的协调工作,使设备和壁板的受力状态恶化,甚至破坏铆钉或壁板。飞机壁板的钻铆质量对后续装配工序也会产生不良影响,严重的会降低整机装配质量和气动外形特性,最终缩短其使用寿命。
在飞机装配过程中,通常借助外部测量***对设备末端位姿进行标定。基于对两定位设备协同工作空间的合理网格划分,和不同温度下对空间网格节点处的相对位姿误差值的测量,可构建一定温度区间内的空间相对位姿误差网格,并通过插值计算目标温度下协同工作空间内任意点的误差值,从而进行误差补偿。在当前研究和应用中,多对单台机器人或机床的空间位置误差进行网格补偿,且多采用固定尺寸网格进行网格划分。但该过程中,没有考虑多设备间的相对位姿精度要求,仅能够满足对单台设备空间位置误差的补偿。
该飞机壁板卧式自动钻铆机是双设备协同工作的复杂***,亟需一种快速有效的方法对双设备相对位姿误差进行补偿,以保证双设备末端的相对位姿精度,从而实现高质量自动化钻铆,最终提升整机的装配质量。
发明内容
为克服现有技术的不足,本发明提供了一种结合温度因素的飞机壁板卧式自动钻铆机空间相对位姿误差补偿方法,可对不同温度下两协同定位设备的空间相对位姿误差进行补偿,以提高两协同设备末端的相对位姿精度,实现高质量自动化钻铆,提升整机装配质量。
结合温度因素的飞机壁板卧式自动钻铆机空间相对位姿误差补偿方法,具体包括如下步骤:
(1)在飞机壁板卧式自动钻铆机***中,分别建立主动定位设备和从动定位设备的基坐标系、各运动轴子坐标系以及末端TCP坐标系,建立工件坐标系、装配坐标系,并绘制坐标系定义图;
(2)对飞机壁板卧式自动钻铆机进行运动学分析,建立运动学模型,并分析主动定位设备与从动定位设备的协同工作空间,对协同工作空间进行网格划分;
(3)在飞机壁板卧式自动钻铆机的两定位设备上,分别安装激光跟踪仪测量用反射镜;并将激光跟踪仪置于能够覆盖到两数控定位设备的运动范围的位置上;
(4)在某一温度下,控制飞机壁板卧式自动钻铆机中的两定位设备运动到网格节点处的指定空间位姿,通过激光跟踪仪的跟踪测量,获取两定位设备上反射镜的一系列位置坐标,并计算两定位设备实际末端位姿;计算协同工作空间各网格节点处两定位设备的实际相对位姿与理论相对位姿之差,形成该温度下的空间相对位姿误差网格;
(5)在一定温度范围内,改变环境温度,测量计算两协同定位设备的实际末端位姿;计算协同工作空间各网格节点处两定位设备的实际相对位姿与理论相对位姿之差,形成不同温度下的空间相对位姿误差网格;
(6)利用两次插值法计算目标温度下协同工作空间网格单元内任意点的误差值;
(7)根据飞机壁板卧式自动钻铆机中两定位设备的主从关系,采用调整从动定位设备关节量的方法,进行两定位设备空间相对位姿误差补偿。
所述的步骤(1)的具体步骤如下:
(1-1)定义飞机壁板卧式自动钻铆机中的各坐标系:定位设备的基坐标系Oj,各运动轴子坐标系Xj、Zj、Yj、Aj、Bj,末端TCP坐标系tj,工件坐标系Ow,以及装配坐标系R;绘制飞机壁板卧式自动钻铆机的坐标系定义图,使各运动轴子坐标系的坐标轴方向与定位设备基坐标系的坐标轴方向一致;
其中,下标j取值为1或2,1表示为主动定位设备,2表示为从动定位设备;
(1-2)将飞机壁板卧式自动钻铆机***中定位设备的基坐标系原点表示为oj,定位设备末端位姿以向量pvj=[pxj,pyj,pzj,wxj,wyj,wzj]表示;
其中,[pxj,pyj,pzj]表示定位设备末端TCP坐标系tj的原点在其基坐标系Oj下的位置坐标,[wxj,wyj,wzj]表示定位设备末端TCP坐标系tj的Z轴姿态向量。
所述的步骤(2)的具体步骤如下:
(2-1)对飞机壁板卧式自动钻铆机进行运动学分析,并建立主动定位设备和从动定位设备的运动学模型:
其中,是从坐标系M到坐标系N的齐次变换矩阵,T1是主动定位设备从基坐标系O1到末端TCP坐标系t1的齐次变换矩阵;T2是从动定位设备从基坐标系O2到末端TCP坐标系t2的齐次变换矩阵;
(2-2)依据定位设备的运动学模型Tj、基坐标系Oj与装配坐标系R的转换关系,将装配坐标系R下两定位设备的末端位姿描述为:
其中,RT1是从装配坐标系R到主动定位设备的末端TCP坐标系t1的齐次变换矩阵;RT2是从装配坐标系R到从动定位设备的末端TCP坐标系t2的齐次变换矩阵;
(2-3)基于运动学模型和两定位设备的末端位姿,分析飞机壁板卧式自动钻铆机中两定位设备的协同工作空间Q,并根据有限元对协同工作空间内的自重变形分析结果对协同工作空间Q进行自适应网格划分,采用立方体网格,网格数目为n。
在步骤(2-3)中,根据对飞机壁板卧式自动钻铆机的自重变形分析结果,对两定位设备的协同工作空间进行自适应网格划分就是在自重变形剧烈处,网格划得小一点,在自重变形平缓处,网格划得大一点,这样能够有效提高空间误差插值精度,从而保证误差补偿的有效性。
所述的步骤(4)的具体步骤如下:
(4-1)在某一温度下,控制主动定位设备运动到网格节点处,其目标位姿为pv1,从动定位设备也运动到相应位姿pv2,理论上满足位姿约束:pv1=pv2
(4-2)激光跟踪仪进行跟踪测量,在两定位设备的主轴进给一定距离后,获取主动定位设备反射镜的一组位置坐标P11和P12,从动定位设备反射镜的一组位置坐标P21和P22,并计算两定位设备末端实际姿态向量N1和N2
其中,P11和P12分别是主动定位设备主轴进给前后的实际末端位置,P21和P22分别是从动定位设备主轴进给前后的实际末端位置;N1是主动定位设备实际的末端姿态向量,N2是从动定位设备实际的末端姿态向量;
(4-3)计算两定位设备末端实际位姿向量pv1'和pv2':
pv1'=[P11N1]
pv2'=[P21N2]
其中,pv1'是主动定位设备的实际末端位姿向量,pv2'是从动定位设备的实际末端姿态向量;
(4-4)设定两定位设备协同工作空间Q内的n个网格中每个立方体网格8个节点,共有i个空间网格节点;
(4-5)在空间网格节点i处,计算两定位设备的理论相对位姿和实际相对位姿,并计算实际相对位姿与理论相对位姿之差:
Δpvi=pvi1-pvi2
Δpvi'=pvi1'-pvi2'
δi=Δpvi'-Δpvi
其中,Δpvi是两定位设备的理论相对位姿;Δpvi′是两定位设备的实际相对位姿;δi是两定位设备的实际相对位姿与理论相对位姿之差;
(4-6)利用两定位设备的实际相对位姿与理论相对位姿之差,形成空间相对位姿误差网格E[δi]。
所述的步骤(5)的具体步骤如下:
(5-1)在[T1,T2]温度范围内,取温度增量为△T,产生一系列温度节点;改变环境温度,在每一温度节点处,按照步骤(4-1)~步骤(4-3)中同样的方法,测量并计算两协同设备的实际末端位姿;
(5-2)计算协同工作空间各网格节点处两定位设备的实际相对位姿与理论相对位姿之差,形成不同温度下的空间相对位姿误差网格E[δi(Tt)]。
所述的步骤(6)的具体步骤如下:
(6-1)根据目标温度T,确定其相邻温度节点Tm和Tn,其中Tm<T<Tn;根据温度Tm和温度Tn下的空间相对位姿误差网格E[δi(Tm)]和E[δi(Tn)],采用线性插值法计算目标温度T下的空间相对位姿误差网格E[δi(T)]:
其中,δi(T)是温度T时两定位设备在空间网格节点i处的实际相对位姿与理论相对位姿之差,形成了该温度下的空间相对位姿误差网格E[δi(T)];
(6-2)确定对应网格单元的形函数,并选择合适的阶次;
8个节点的立方体网格,对应其一阶形函数为:
其中,i为空间网格节点;r,s,t是网格内局部坐标系的三维坐标轴,该局部坐标系的原点为网格中心点r,s,t的取值为:
其中,x,y,z是网格中任意点的坐标;a,b,c是网格单元在x,y,z方向上的长度的一半;则网格中心点的坐标取值为:
20个节点的立方体网格,对应其二阶形函数为:
(6-3)根据(6-2)中的形函数,计算温度T时协同工作空间网格单元内任意点的误差值:
其中,δ(T)是温度T时插值所得的网格中任意点的相对位姿误差值;δi(T)是温度T时网格节点处相对位姿误差值;m是每个网格单元的节点数目,一阶立方体网格的m=8,二阶立方体网格的m=20;
(6-4)将变形网格单元中的任意点通过映射关系f映射到正常网格单元内,并采用局部坐标(r,s,t)表示,然后执行步骤(6-2)和步骤(6-3),其映射关系f为:
其中,xi,yi,zi是局部网格节点在全局坐标系中的坐标。
所述的步骤(7)的具体步骤如下:
(7-1)利用从动定位设备的运动学反解算法计算从动定位设备的关节量补偿量;
Δq2=Inv(δ(T))
其中,δ(T)是温度T时空间任意点的相对位姿误差值;Inv()是从动定位设备的运动学反解算法;Δq2是从动定位设备的关节量补偿量;
(7-2)在控制***中增加从动定位设备的关节量补偿量,实现对两设备空间相对位姿误差的补偿:
q2'=q2+Δq2
其中,q2是从动定位设备误差补偿前的关节量,即按目标位姿pv2进行运动学反解所得的关节量;q2'是从动定位设备进行误差补偿后的关节量。
通过本发明方法,实现目标温度下飞机壁板卧式自动钻铆机中两协同定位设备的空间相对位姿误差补偿。
本发明结合温度因素的飞机壁板卧式自动钻铆机空间相对位姿误差补偿方法:分析飞机壁板卧式自动钻铆机中两定位设备的协同工作空间,并进行合理的网格划分;在不同温度下,激光跟踪仪通过跟踪测量两定位设备的实际相对位姿误差,构建一定温度区间内的空间相对位姿误差网格,并通过插值计算目标温度下协同工作空间网格内任意点的误差值;依照两定位设备的主从关系,采用通过从动定位设备进行两协同设备空间相对位姿误差补偿的策略,实现误差补偿。
与现有技术相比,本发明的优点在于:
(1)实现了在装配坐标系下,对飞机壁板卧式自动钻铆机中两定位设备协同工作空间的分析,可有效指导工装入位,并为协同设备空间相对位姿误差补偿奠定基础;
(2)根据对飞机壁板卧式自动钻铆机的自重变形分析结果,对两定位设备的协同工作空间进行自适应网格划分,有效提高空间误差插值精度,从而保证误差补偿的有效性;
(3)通过激光跟踪仪对飞机壁板卧式自动钻铆机中两定位设备的实际位姿进行快速有效的测量,为协同设备相对位姿误差补偿提供了数据支持;且激光跟踪仪的位置不影响测量结果,只需保证其测量范围覆盖到两定位设备的协同工作空间即可,大大方便了误差测量中的测量设备布置,节省了误差测量过程的时间;
(4)同时采用线性插值法和形函数插值法,有效计算目标温度下协同工作空间内任意点的相对位姿误差值,并根据飞机壁板卧式自动钻铆机中两定位设备的主从关系,提出了通过从动定位设备进行误差补偿的策略,实现了全协同工作空间内对协同设备相对位姿误差的有效补偿;
(5)为多设备空间相对位姿误差的补偿提供了一种思路,快速有效地提高了多设备协同工作精度,提高了飞机装配中的孔加工质量,提升了飞机部件整体的装配质量与装配效率。
附图说明
图1为本发明飞机壁板卧式自动钻铆机空间相对位姿误差补偿方法的流程示意图;
图2为飞机壁板卧式自动钻铆机的坐标系定义图;
图3为一阶形函数对应的立方体网格单元及局部坐标系示意图;
图4为二阶形函数对应的立方体网格单元及局部坐标系示意图;
图5为正常网格单元与变形网格单元示意图。
具体实施方式
为了更为具体地描述本发明,下面结合附图及具体实施方式对本发明的技术方案进行详细说明。
本发明中所述的主动定位设备和从动定位设备分别为CN105643278A所公开的一种用于飞机壁板装配的卧式自动钻铆机床中的制孔插钉侧数控定位设备和镦紧侧数控定位设备。
如图1所示,本发明一种结合温度因素的飞机壁板卧式自动钻铆机空间相对位姿误差补偿方法具体包括:
步骤1,定义飞机壁板卧式自动钻铆机中的各坐标系:
主动定位设备的基坐标系O1,各运动轴子坐标系X1、Z1、Y1、A1、B1,末端TCP坐标系t1
从动定位设备的基坐标系O2,各运动轴子坐标系X2、Z2、Y2、A2、B2,末端TCP坐标系t2
工件坐标系Ow,装配坐标系R;
并绘制飞机壁板卧式自动钻铆机的坐标系定义图,使各运动轴子坐标系的坐标轴方向与定位设备基坐标系的坐标轴方向一致,如图2所示。
步骤2,将主动定位设备的基坐标系原点表示为o1,末端位姿以向量pv1=[px1,py1,pz1,wx1,wy1,wz1]表示;将从动定位设备的基坐标系原点表示为o2,末端位姿以向量pv2=[px2,py2,pz2,wx2,wy2,wz2]表示;
其中,[px1,py1,pz1]表示主动定位设备末端TCP坐标系的原点在其基坐标系O1下的位置坐标,[wx1,wy1,wz1]表示主动定位设备末端TCP坐标系的Z轴姿态向量;[px2,py2,pz2]表示从动定位设备末端TCP坐标系的原点在其基坐标系O2下的位置坐标,[wx2,wy2,wz2]表示从动定位设备末端TCP坐标系的Z轴姿态向量。
步骤3,对飞机壁板卧式自动钻铆机进行运动学分析,并建立主动定位设备和从动定位设备的运动学模型:
其中,是从坐标系M到坐标系N的齐次变换矩阵,T1是主动定位设备从基坐标系O1到末端TCP坐标系t1的齐次变换矩阵;T2是从动定位设备从基坐标系O2到末端TCP坐标系t2的齐次变换矩阵。
步骤4,依据定位设备的运动学模型Tj、基坐标系Oj与装配坐标系R的转换关系,将装配坐标系R下两定位设备的末端位姿描述为:
其中,RT1是从装配坐标系R到主动定位设备的末端TCP坐标系t1的齐次变换矩阵;RT2是从装配坐标系R到从动定位设备的末端TCP坐标系t2的齐次变换矩阵。
步骤5,基于运动学模型和两定位设备的末端位姿约束条件,分析飞机壁板卧式自动钻铆机中两定位设备的协同工作空间Q,并根据有限元对协同工作空间内的自重变形分析结果对协同工作空间Q进行自适应网格划分,采用立方体网格,网格数目为n。
根据对飞机壁板卧式自动钻铆机的自重变形分析结果,对两定位设备的协同工作空间进行自适应网格划分,有效提高空间误差插值精度,从而保证误差补偿的有效性。
步骤6,在飞机壁板卧式自动钻铆机的两定位设备上,分别安装激光跟踪仪测量用反射镜;并将激光跟踪仪置于能够覆盖到两数控定位设备的运动范围的位置上。
步骤7,在某一温度下,控制主动定位设备运动到网格节点处,其目标位姿为pv1,从动定位设备也运动到相应位姿pv2,理论上满足位姿约束:pv1=pv2
步骤8,激光跟踪仪进行跟踪测量,在两定位设备的主轴进给一定距离后,获取主动定位设备反射镜的一组位置坐标P11和P12,从动定位设备反射镜的一组位置坐标P21和P22,并计算两定位设备末端实际姿态向量N1和N2
其中,P11和P12分别是主动定位设备主轴进给前后的实际末端位置,P21和P22分别是从动定位设备主轴进给前后的实际末端位置;N1是主动定位设备实际的末端姿态向量,N2是从动定位设备实际的末端姿态向量;
步骤9,计算两定位设备末端实际位姿向量pv1'和pv2':
pv1'=[P11N1]
pv2'=[P21N2]
其中,pv1'是主动定位设备的实际末端位姿向量,pv2'是从动定位设备的实际末端姿态向量;
步骤10,设定两定位设备协同工作空间Q内的n个网格中每个立方体网格8个节点,共有i个空间网格节点;
步骤11,在空间网格节点i处,计算两定位设备的理论相对位姿和实际相对位姿,并计算实际相对位姿与理论相对位姿之差:
Δpvi=pvi1-pvi2
Δpvi'=pvi1'-pvi2'
δi=Δpvi'-Δpvi
其中,Δpvi是两定位设备的理论相对位姿;Δpvi′是两定位设备的实际相对位姿;δi是两定位设备的实际相对位姿与理论相对位姿之差;
步骤12,利用两定位设备的实际相对位姿与理论相对位姿之差,形成空间相对位姿误差网格E[δi]。
步骤13,在[T1,T2]温度范围内,取温度增量为△T,产生一系列温度节点;改变环境温度,在每一温度节点处,按照步骤(4-1)~步骤(4-3)中同样的方法,测量并计算两协同设备的实际末端位姿;
步骤14,计算协同工作空间各网格节点处两定位设备的实际相对位姿与理论相对位姿之差,形成不同温度下的空间相对位姿误差网格E[δi(Tt)]。
步骤15,根据目标温度T,确定其相邻温度节点Tm和Tn,其中Tm<T<Tn;根据温度Tm和温度Tn下的空间相对位姿误差网格E[δi(Tm)]和E[δi(Tn)],采用线性插值法计算目标温度T下的空间相对位姿误差网格E[δi(T)]:
其中,δi(T)是温度T时两定位设备在空间网格节点i处的实际相对位姿与理论相对位姿之差,形成了该温度下的空间相对位姿误差网格E[δi(T)];
步骤16,确定对应网格单元的形函数,并选择合适的阶次;
如图3所示的8个节点的立方体网格,对应其一阶形函数为:
其中,i为空间网格节点;r,s,t是网格内局部坐标系的三维坐标轴,该局部坐标系示意图如图3所示,该局部坐标系的原点为网格中心点r,s,t的取值为:
其中,x,y,z是网格中任意点的坐标;a,b,c是网格单元在x,y,z方向上的长度的一半;则网格中心点的坐标取值为:
如图4所示的20个节点的立方体网格,对应其二阶形函数为:
步骤17,根据步骤16中的形函数,计算温度T时协同工作空间网格单元内任意点的误差值:
其中,δ(T)是温度T时插值所得的网格中任意点的相对位姿误差值;δi(T)是温度T时网格节点处相对位姿误差值;m是每个网格单元的节点数目,一阶立方体网格的m=8,二阶立方体网格的m=20;
步骤18,图5所示的是正常网格单元与变形网格单元示意图,为计算变形网格单元中任意点的误差值,将变形网格单元中的任意点通过映射关系f映射到正常网格单元内,并采用局部坐标(r,s,t)表示,然后执行步骤16和步骤17,其映射关系f为:
其中,xi,yi,zi是局部网格节点在全局坐标系中的坐标。
步骤19,利用从动定位设备的运动学反解算法计算从动定位设备的关节量补偿量;
Δq2=Inv(δ(T))
其中,δ(T)是温度T时空间任意点的相对位姿误差值;Inv()是从动定位设备的运动学反解算法;Δq2是从动定位设备的关节量补偿量;
步骤20,在控制***中增加从动定位设备的关节量补偿量,实现对两设备空间相对位姿误差的补偿:
q2'=q2+Δq2
其中,q2是从动定位设备误差补偿前的关节量,即按目标位姿pv2进行运动学反解所得的关节量;q2'是从动定位设备进行误差补偿后的关节量。
步骤21,根据主动定位设备的目标末端位姿pv1计算主动定位设备的关节量q1,并将关节量q1和关节量q2输入到飞机壁板卧式自动钻铆机控制***,得到飞机壁板卧式自动钻铆机两定位设备的误差补偿后的末端位姿。
相比于无空间相对位姿误差补偿的飞机壁板卧式自动钻铆机,本发明不但对空间相对位姿误差进行了补偿,而且还考虑了环境温度对误差值的影响,这使得空间相对位姿误差补偿方法调整后的飞机壁板卧式自动钻铆机制孔精度提高了50%,这大大提高了飞机壁板的钻铆质量,进而提高了整机装配质量和气动外形特性,最终延长了其使用寿命。
以上所述的具体实施方式对本发明的技术方案和有益效果进行了详细说明,应理解的是以上所述仅为本发明的最优选实施例,并不用于限制本发明,凡在本发明的原则范围内所做的任何修改、补充和等同替换等,均应包含在本发明的保护范围之内。

Claims (7)

1.一种结合温度因素的飞机壁板卧式自动钻铆机空间相对位姿误差补偿方法,具体包括如下步骤:
(1)在飞机壁板卧式自动钻铆机***中,分别建立主动定位设备和从动定位设备的基坐标系、各运动轴子坐标系以及末端TCP坐标系,建立工件坐标系、装配坐标系,并绘制坐标系定义图;
(2)对飞机壁板卧式自动钻铆机进行运动学分析,建立运动学模型,并分析主动定位设备与从动定位设备的协同工作空间,对协同工作空间进行网格划分;
(3)在飞机壁板卧式自动钻铆机的两定位设备上,分别安装激光跟踪仪测量用反射镜;并将激光跟踪仪置于能够覆盖到两定位设备的运动范围的位置上;
(4)在某一温度下,控制飞机壁板卧式自动钻铆机中的两定位设备运动到网格节点处的指定空间位姿,通过激光跟踪仪的跟踪测量,获取两定位设备上反射镜的一系列位置坐标,并计算两定位设备实际末端位姿;计算协同工作空间各网格节点处两定位设备的实际相对位姿与理论相对位姿之差,形成该温度下的空间相对位姿误差网格;
(5)在一定温度范围内,改变环境温度,测量计算两定位设备的实际末端位姿;计算协同工作空间各网格节点处两定位设备的实际相对位姿与理论相对位姿之差,形成不同温度下的空间相对位姿误差网格;
(6)利用两次插值法计算目标温度下协同工作空间网格单元内任意点的误差值;
(7)根据飞机壁板卧式自动钻铆机中两定位设备的主从关系,采用调整从动定位设备关节量的方法,进行两定位设备空间相对位姿误差补偿。
2.根据权利要求1所述结合温度因素的飞机壁板卧式自动钻铆机空间相对位姿误差补偿方法,其特征在于:所述的步骤(1)的具体步骤如下:
(1-1)定义飞机壁板卧式自动钻铆机中的各坐标系:定位设备的基坐标系Oj,各运动轴子坐标系Xj、Zj、Yj、Aj、Bj,末端TCP坐标系tj,工件坐标系Ow,以及装配坐标系R;绘制飞机壁板卧式自动钻铆机的坐标系定义图,使各运动轴子坐标系的坐标轴方向与定位设备基坐标系的坐标轴方向一致;
其中,下标j取值为1或2,1表示为主动定位设备,2表示为从动定位设备;
(1-2)将飞机壁板卧式自动钻铆机***中定位设备的基坐标系原点表示为oj,定位设备末端位姿以向量pvj=[pxj,pyj,pzj,wxj,wyj,wzj]表示;
其中,[pxj,pyj,pzj]表示定位设备末端TCP坐标系tj的原点在其基坐标系Oj下的位置坐标,[wxj,wyj,wzj]表示定位设备末端TCP坐标系tj的Z轴姿态向量。
3.根据权利要求1所述结合温度因素的飞机壁板卧式自动钻铆机空间相对位姿误差补偿方法,其特征在于:所述的步骤(2)的具体步骤如下:
(2-1)对飞机壁板卧式自动钻铆机进行运动学分析,并建立主动定位设备和从动定位设备的运动学模型:
其中,是从坐标系M到坐标系N的齐次变换矩阵,T1是主动定位设备从基坐标系O1到末端TCP坐标系t1的齐次变换矩阵;T2是从动定位设备从基坐标系O2到末端TCP坐标系t2的齐次变换矩阵;
(2-2)依据定位设备的运动学模型Tj、基坐标系Oj与装配坐标系R的转换关系,将装配坐标系R下两定位设备的末端位姿描述为:
其中,RT1是从装配坐标系R到主动定位设备的末端TCP坐标系t1的齐次变换矩阵;RT2是从装配坐标系R到从动定位设备的末端TCP坐标系t2的齐次变换矩阵;
(2-3)基于运动学模型和两定位设备的末端位姿约束关系,分析飞机壁板卧式自动钻铆机中两定位设备的协同工作空间Q,并根据有限元对协同工作空间内的自重变形分析结果对协同工作空间Q进行自适应网格划分,采用立方体网格,网格数目为n。
4.根据权利要求1所述结合温度因素的飞机壁板卧式自动钻铆机空间相对位姿误差补偿方法,其特征在于:所述的步骤(4)的具体步骤如下:
(4-1)在某一温度下,控制主动定位设备运动到网格节点处,其目标位姿为pv1,从动定位设备也运动到相应位姿pv2,理论上满足位姿约束:pv1=pv2
(4-2)激光跟踪仪进行跟踪测量,在两定位设备的主轴进给一定距离后,获取主动定位设备反射镜的一组位置坐标P11和P12,从动定位设备反射镜的一组位置坐标P21和P22,并计算两定位设备末端实际姿态向量N1和N2
其中,P11和P12分别是主动定位设备主轴进给前后的实际末端位置,P21和P22分别是从动定位设备主轴进给前后的实际末端位置;N1是主动定位设备实际的末端姿态向量,N2是从动定位设备实际的末端姿态向量;
(4-3)计算两定位设备末端实际位姿向量pv1'和pv2':
pv1'=[P11 N1]
pv2'=[P21 N2]
其中,pv1'是主动定位设备的实际末端位姿向量,pv2'是从动定位设备的实际末端姿态向量;
(4-4)设定两定位设备协同工作空间Q内的n个网格中每个立方体网格8个节点,共有i个空间网格节点;
(4-5)在空间网格节点i处,计算两定位设备的理论相对位姿和实际相对位姿,并计算实际相对位姿与理论相对位姿之差:
Δpvi=pvi1-pvi2
Δpvi'=pvi1'-pvi2'
δi=Δpvi'-Δpvi
其中,Δpvi是两定位设备的理论相对位姿;Δpvi′是两定位设备的实际相对位姿;δi是两定位设备的实际相对位姿与理论相对位姿之差;
(4-6)利用两定位设备的实际相对位姿与理论相对位姿之差,形成空间相对位姿误差网格E[δi]。
5.根据权利要求4所述结合温度因素的飞机壁板卧式自动钻铆机空间相对位姿误差补偿方法,其特征在于:所述的步骤(5)的具体步骤如下:
(5-1)在[T1,T2]温度范围内,取温度增量为△T,产生一系列温度节点;改变环境温度,在每一温度节点处,按照步骤(4-1)~步骤(4-3)中同样的方法,测量并计算两定位设备的实际末端位姿;
(5-2)计算协同工作空间各网格节点处两定位设备的实际相对位姿与理论相对位姿之差,形成不同温度下的空间相对位姿误差网格E[δi(Tt)]。
6.根据权利要求1所述结合温度因素的飞机壁板卧式自动钻铆机空间相对位姿误差补偿方法,其特征在于:所述的步骤(6)的具体步骤如下:
(6-1)根据目标温度T,确定其相邻温度节点Tm和Tn,其中Tm<T<Tn;根据温度Tm和温度Tn下的空间相对位姿误差网格E[δi(Tm)]和E[δi(Tn)],采用线性插值法计算目标温度T下的空间相对位姿误差网格E[δi(T)]:
其中,δi(T)是温度T时两定位设备在空间网格节点i处的实际相对位姿与理论相对位姿之差,形成了该温度下的空间相对位姿误差网格E[δi(T)];
(6-2)确定对应网格单元的形函数,并选择合适的阶次;
8个节点的立方体网格,对应其一阶形函数为:
其中,i为空间网格节点;r,s,t是网格内局部坐标系的三维坐标轴,该局部坐标系的原点为网格中心点r,s,t的取值为:
其中,x,y,z是网格中任意点的坐标;a,b,c是网格单元在x,y,z方向上的长度的一半;则网格中心点的坐标取值为:
20个节点的立方体网格,对应其二阶形函数为:
(6-3)根据(6-2)中的形函数,计算温度T时协同工作空间网格单元内任意点的误差值:
其中,δ(T)是温度T时插值所得的网格中任意点的相对位姿误差值;δi(T)是温度T时网格节点处相对位姿误差值;m是每个网格单元的节点数目,一阶立方体网格的m=8,二阶立方体网格的m=20;
(6-4)将变形网格单元中的任意点通过映射关系f映射到正常网格单元内,并采用局部坐标(r,s,t)表示,然后执行步骤(6-2)和步骤(6-3),其映射关系f为:
其中,xi,yi,zi是局部网格节点在全局坐标系中的坐标。
7.根据权利要求1所述结合温度因素的飞机壁板卧式自动钻铆机空间相对位姿误差补偿方法,其特征在于:所述的步骤(7)的具体步骤如下:
(7-1)利用从动定位设备的运动学反解算法计算从动定位设备的关节量补偿量;
Δq2=Inv(δ(T))
其中,δ(T)是温度T时空间任意点的相对位姿误差值;Inv()是从动定位设备的运动学反解算法;Δq2是从动定位设备的关节量补偿量;
(7-2)在控制***中增加从动定位设备的关节量补偿量,实现对两设备空间相对位姿误差的补偿:
q2'=q2+Δq2
其中,q2是从动定位设备误差补偿前的关节量,即按目标位姿pv2进行运动学反解所得的关节量;q2'是从动定位设备进行误差补偿后的关节量。
CN201610946457.0A 2016-11-02 2016-11-02 结合温度因素的飞机壁板卧式自动钻铆机空间相对位姿误差补偿方法 Active CN106516153B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610946457.0A CN106516153B (zh) 2016-11-02 2016-11-02 结合温度因素的飞机壁板卧式自动钻铆机空间相对位姿误差补偿方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610946457.0A CN106516153B (zh) 2016-11-02 2016-11-02 结合温度因素的飞机壁板卧式自动钻铆机空间相对位姿误差补偿方法

Publications (2)

Publication Number Publication Date
CN106516153A CN106516153A (zh) 2017-03-22
CN106516153B true CN106516153B (zh) 2018-07-06

Family

ID=58292497

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610946457.0A Active CN106516153B (zh) 2016-11-02 2016-11-02 结合温度因素的飞机壁板卧式自动钻铆机空间相对位姿误差补偿方法

Country Status (1)

Country Link
CN (1) CN106516153B (zh)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111745643A (zh) * 2020-05-28 2020-10-09 西华大学 主机器人和从机器人遥操作***位置控制方法
CN114239170A (zh) * 2021-12-15 2022-03-25 成都飞机工业(集团)有限责任公司 一种飞机装配的误差补偿方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101493683A (zh) * 2009-01-09 2009-07-29 成都飞机工业(集团)有限责任公司 一种基于数字化误差补偿模板实现飞机大部件数控精加工的方法
CN103143984A (zh) * 2013-04-09 2013-06-12 重庆大学 基于激光跟踪仪的机床误差动态补偿方法
CN105404237A (zh) * 2015-11-10 2016-03-16 湖北文理学院 一种基于空间网格补偿方式的数控机床空间误差建模方法
CN105643278A (zh) * 2016-02-29 2016-06-08 浙江大学 一种用于飞机壁板装配的卧式自动钻铆机床
CN105678023A (zh) * 2016-02-24 2016-06-15 浙江大学 一种飞机壁板卧式自动钻铆机的运动参数辨识方法
CN105698678A (zh) * 2016-02-24 2016-06-22 浙江大学 一种飞机壁板卧式自动钻铆机的基坐标系标定方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101493683A (zh) * 2009-01-09 2009-07-29 成都飞机工业(集团)有限责任公司 一种基于数字化误差补偿模板实现飞机大部件数控精加工的方法
CN103143984A (zh) * 2013-04-09 2013-06-12 重庆大学 基于激光跟踪仪的机床误差动态补偿方法
CN105404237A (zh) * 2015-11-10 2016-03-16 湖北文理学院 一种基于空间网格补偿方式的数控机床空间误差建模方法
CN105678023A (zh) * 2016-02-24 2016-06-15 浙江大学 一种飞机壁板卧式自动钻铆机的运动参数辨识方法
CN105698678A (zh) * 2016-02-24 2016-06-22 浙江大学 一种飞机壁板卧式自动钻铆机的基坐标系标定方法
CN105643278A (zh) * 2016-02-29 2016-06-08 浙江大学 一种用于飞机壁板装配的卧式自动钻铆机床

Also Published As

Publication number Publication date
CN106516153A (zh) 2017-03-22

Similar Documents

Publication Publication Date Title
CN106542113B (zh) 一种飞机壁板卧式自动钻铆机空间相对位姿误差补偿方法
CN106625573B (zh) 一种五自由度混联机器人直接误差补偿技术
CN112959325B (zh) 一种大场景下的双移动机械臂协同加工高精度控制方法
Loose et al. Kinematic analysis of dimensional variation propagation for multistage machining processes with general fixture layouts
CN105698678B (zh) 一种飞机壁板卧式自动钻铆机的基坐标系标定方法
CN109613519A (zh) 基于多激光跟踪仪测量场的对合调姿方法
CN110193829A (zh) 一种耦合运动学与刚度参数辨识的机器人精度控制方法
Zhang et al. Measurement and compensation for volumetric positioning errors of CNC machine tools considering thermal effect
CN108015767A (zh) 一种空间机械臂应急操作方法
CN106516153B (zh) 结合温度因素的飞机壁板卧式自动钻铆机空间相对位姿误差补偿方法
CN103164584B (zh) 基于关键特性的协调准确度计算方法
CN105678023A (zh) 一种飞机壁板卧式自动钻铆机的运动参数辨识方法
CN103144109B (zh) 一种用于附加外部轴的机器人***分站式精度补偿方法
CN111536901A (zh) 一种基于现场龙门与机器人组合式三维激光扫描测量方法
CN102991724A (zh) 利用工作空间测量定位***进行飞机大部件对接的方法
CN105354360A (zh) 飞机大部件装配界面精加工坐标测量控制网闭环建立方法
CN105912007A (zh) 空间机械臂抗干扰姿态稳定的微分几何非线性控制方法
Zhong et al. Volumetric error modeling, identification and compensation based on screw theory for a large multi-axis propeller-measuring machine
CN103950552A (zh) 基于六轴数控***的飞机壁板装配变形的数字化校正方法
CN105798706B (zh) 一种用于飞机壁板卧式自动钻铆机的末端精度重力补偿方法
CN109101671A (zh) 一种变密度与变构型三维点阵结构建模方法
CN108959702A (zh) 一种基于面偏差传递的火箭贮箱偏差分析方法
CN113065259A (zh) 一种壁板组件与骨架位姿协调方法
CN103895878A (zh) 一种大型飞机后机身数字化装配***
CN104750977B (zh) 一种复合位置度误差评定的方法及装置

Legal Events

Date Code Title Description
C06 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