一种残膜回收机防缠绕挑膜装置的制 一种秧草收获机用电力驱动行走机构

一种多数控定位器物理空间任意轴线的坐标变换方法与流程

2021-08-13 19:31:00 来源:中国专利 TAG:定位器 轴线 坐标 装配 变换
一种多数控定位器物理空间任意轴线的坐标变换方法与流程

本发明涉及飞机调姿装配技术领域,具体涉及一种多数控定位器物理空间任意轴线的坐标变换方法。



背景技术:

在飞机大部件调姿对合、大部件高精度装配应用领域,一般采用多个三坐标数控定位器实现对飞机部件的支撑定位,以三段飞机大部件为例,每段飞机大部件由四个三坐标数控定位器进行支撑定位并通过三坐标数控定位器的运动实现其位姿调整,三段大部件共计需要十二台三坐标数控定位器实现对其支撑定位,为了能够清晰地描述飞机大部件关键点的特征数据,确保飞机大部件在调姿运动过程中的可靠性,需建立独立于定位器的飞机坐标系,三坐标数控定位器的x轴、y轴及z轴原则上要能够和飞机坐标系的x轴、y轴及z轴平行,但是在三坐标数控定位器的实际装调过程中,三坐标数控定位器的布局跨度可能达到10米甚至更长,目前的做法是通过不断调整、修正三坐标数控定位器的几何精度以确保三坐标数控定位器的各物理轴和飞机坐标系的x、y、z轴的关系满足一定的误差范围,但是,要想保证三坐标数控定位器的x轴、y轴及z轴原则上要能够和飞机坐标系的x轴、y轴及z轴平行对测量设备的精度及工人的技术水平及劳动强度均会造成极大的挑战,且在系统使用一段时间后,需要定期进行复检,精度无法得到保证,甚至影响飞机大部件调姿的准确性。



技术实现要素:

针对现有技术中的缺陷,本发明提供一种多数控定位器物理空间任意轴线的坐标变换方法,以达到基于数学公式大致保证三坐标数控定位器和飞机坐标系的平行度即可,无需耗费大量人力物力来实现三坐标数控定位器几何调试的作用。

为解决上述的技术问题,本发明采用以下技术方案:

一种多数控定位器物理空间任意轴线的坐标变换方法,包括以下步骤:

步骤一:建立全局飞机坐标系,分别将多个三坐标数控定位器纵横排列安放在对应定位器安装板上,先确定y轴,然后获取水平面作为飞机坐标系的xy平面,获取飞机坐标系的x轴及z轴并确定飞机坐标系的原点o(x0,y0,z0);

步骤二:移动其中一个三坐标数控定位器的x轴处于多个不同位置,通过激光跟踪仪测量不同位置处的坐标数据并通过激光跟踪仪直线拟合确定该三坐标数控定位器的x轴轴线向量(v1xx,v1xy,v1xz);

步骤三:移动步骤二中所述三坐标数控定位器的y轴处于多个不同位置,通过激光跟踪仪测量不同位置处的坐标数据并通过激光跟踪仪直线拟合确定该三坐标数控定位器的y轴轴线向量(v1yx,v1yy,v1yz);

步骤四:移动步骤二中所述三坐标数控定位器的z轴处于多个不同位置,通过激光跟踪仪测量不同位置处的坐标数据并通过激光跟踪仪直线拟合确定该三坐标数控定位器的z轴轴线向量(v1zx,v1zy,v1zz);

步骤五:移动步骤四中所述三坐标数控定位器各轴回到初始位置处,拟合三坐标数控定位器球窝中心点获取其在飞机坐标系下的初始位置p1(x10,y10,z10);

步骤六:重复步骤二至步骤五获取其余三坐标数控定位器的x轴轴线向量(vnxx,vnxy,vnxz)、y轴轴线向量(vnyx,vnyy,vnyz)、z轴轴线向量(vnzx,vnzy,vnzz)及初始位置pn(xn0,yn0,zn0),其中n为剩余三坐标数控定位器的编号;

步骤七:根据飞机大部件在飞机坐标系下位姿调整,获取步骤5中所述三坐标数控定位器的球窝中心在飞机坐标系下的目标位置p1’(x10’,y10’,z10’),通过如下位置逆解公式计算出该三坐标数控定位器的物理轴所需要的移动量(δx1m,δy1m,δz1m):

m=v1xx*v1yy*v1zz v1xy*v1yz*v1zx v1xz*v1yx*v1zy-v1xx*v1yz*v1zy-v1xy*v1yx*v1zz-v1xz*v1yy*v1zx;

mx=(x’10-x10)*v1yy*v1zz (y’10-y10)*v1yz*v1zx (z’10-z10)*v1yx*v1zx-(x’10-x10)*v1yz*v1zy-(y’10-y10)*v1yx*v1zz-(z’10-z10)*v1yy*v1zx;

my=(y’10-y10)*v1xx*v1zz (z’10-z10)*v1xy*v1zx (x’10-x10)*v1xz*v1zy-(z’10-z10)*v1xx*v1zy-(x’10-x10)*v1xy*v1zz-(y’10-y10)*v1xz*v1zx;

mz=(z’10-z10)*v1xx*v1yy (x’10-x10)*v1xy*v1yz (y’10-y10)*v1xz*v1yx-(y’10-y10)*v1xx*v1yz-(z’10-z10)*v1xy*v1yx-(x’10-x10)*v1xz*v1yy;

则得出:δx1m=mx/m,δy1m=my/m,δz1m=mz/m;

步骤八:重复步骤七,获取其余三坐标数控定位器的球窝中心在飞机坐标系下的目标位置pn’(xn0’,yn0’,zn0’),并按照步骤七中位置逆解公式计算得到其余三坐标数控定位器的物理轴所需要的移动量(δxnm,δynm,δznm),其中n为剩余三坐标数控定位器的编号;

步骤九:将各三坐标数控定位器物理轴的移动量下发至运动控制器,运动控制器驱动三坐标数控定位器所有运动轴同步运动,实现飞机大部件的位姿调整。

优选地,在步骤一中,确定y轴时采用以下方法:

以同一列定位器安装板中心点连线所构成的中心线作为飞机坐标系的y轴。

优选地,在步骤一中,通过在平台上放置水平仪以实现所述获取水平面作为飞机坐标系的xy平面。

优选地,在步骤一中,通过右手定则以实现所述获取飞机坐标系的x轴及z轴并确定飞机坐标系的原点o(x0,y0,z0),所述右手定则为:以右手握住z轴,当右手的四指从正向x轴以π/2角度转向正向y轴时,大拇指的指向即z轴的正向。

优选地,在步骤二至步骤四中,所述多个不同位置为不少于10个的不同位置。

优选地,三坐标数控定位器的数量为4m个,m为由1开始的自然数。

本发明的有益效果体现在:

1、操作性强,本发明方法通过激光跟踪仪标定各物理轴轴线的方向向量,仅需大致保证三坐标数控定位器和飞机坐标系的平行度即可,无需耗费大量人力物力来实现三坐标数控定位器的几何调试;

2、精度及可靠性高,本发明方法能够根据各物理轴的轴线方向,精确计算出各物理轴在飞机大部件调姿过程中所需要的移动量,确保大部件调姿过程的稳定可靠;

3、通用性好,本发明方法通过数学公式实现,仅需获取各三坐标数控定位器的实际物理轴位置和定位器物理轴轴线即可,可以封装在运动控制器底层,不受系统的影响;

4、可维护性好,本发明方法在三坐标数控定位器使用一段时间后,仅需重新标定各物理轴轴线的方向向量即可实现几何精度的修正,无需再进行几何精度调整。

附图说明

为了更清楚地说明本发明具体实施方式或现有技术中的技术方案,下面将对具体实施方式或现有技术描述中所需要使用的附图作简单的介绍。在所有附图中,类似的元件或部分一般由类似的附图标记标识。附图中,各元件或部分并不一定按照实际的比例绘制。

图1为单段飞机大部件四个三坐标数控定位器组的结构示意图;

图2为单个三坐标数控定位器的结构示意图。

具体实施方式

为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。通常在此处附图中描述和示出的本发明实施例的组件可以以各种不同的配置来布置和设计。

因此,以下对在附图中提供的本发明的实施例的详细描述并非旨在限制要求保护的本发明的范围,而是仅仅表示本发明的选定实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。

应注意到:相似的标号和字母在下面的附图中表示类似项,因此,一旦某一项在一个附图中被定义,则在随后的附图中不需要对其进行进一步定义和解释。

在本发明实施例的描述中,需要说明的是,若出现术语“中心”、“上”、“下”、“左”、“右”、“竖直”、“水平”、“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系,或者是该发明产品使用时惯常摆放的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。此外,术语“第一”、“第二”、“第三”等仅用于区分描述,而不能理解为指示或暗示相对重要性。

此外,若出现术语“水平”、“竖直”、“悬垂”等术语并不表示要求部件绝对水平或悬垂,而是可以稍微倾斜。如“水平”仅仅是指其方向相对“竖直”而言更加水平,并不是表示该结构一定要完全水平,而是可以稍微倾斜。

在本发明实施例的描述中,“若干”代表至少2个。

在本发明实施例的描述中,还需要说明的是,除非另有明确的规定和限定,若出现术语“设置”、“安装”、“相连”、“连接”应做广义理解,例如,可以是固定连接,也可以是可拆卸连接,或一体地连接;可以是机械连接,也可以是电连接;可以是直接相连,也可以通过中间媒介间接相连,可以是两个元件内部的连通。对于本领域的普通技术人员而言,可以根据具体情况理解上述术语在本发明中的具体含义。

实施例1

如图1-2所示,本实施例提供一种多数控定位器物理空间任意轴线的坐标变换方法,包括以下步骤:

步骤一:建立全局飞机坐标系,分别将多个三坐标数控定位器纵横排列安放在对应定位器安装板上,先确定y轴,然后获取水平面作为飞机坐标系的xy平面,获取飞机坐标系的x轴及z轴并确定飞机坐标系的原点o(x0,y0,z0);

步骤二:移动其中一个三坐标数控定位器的x轴处于多个不同位置,通过激光跟踪仪测量不同位置处的坐标数据并通过激光跟踪仪直线拟合确定该三坐标数控定位器的x轴轴线向量(v1xx,v1xy,v1xz);

步骤三:移动步骤二中所述三坐标数控定位器的y轴处于多个不同位置,通过激光跟踪仪测量不同位置处的坐标数据并通过激光跟踪仪直线拟合确定该三坐标数控定位器的y轴轴线向量(v1yx,v1yy,v1yz);

步骤四:移动步骤二中所述三坐标数控定位器的z轴处于多个不同位置,通过激光跟踪仪测量不同位置处的坐标数据并通过激光跟踪仪直线拟合确定该三坐标数控定位器的z轴轴线向量(v1zx,v1zy,v1zz);

步骤五:移动步骤四中所述三坐标数控定位器各轴回到初始位置处,拟合三坐标数控定位器球窝中心点获取其在飞机坐标系下的初始位置p1(x10,y10,z10);

步骤六:重复步骤二至步骤五获取其余三坐标数控定位器的x轴轴线向量(vnxx,vnxy,vnxz)、y轴轴线向量(vnyx,vnyy,vnyz)、z轴轴线向量(vnzx,vnzy,vnzz)及初始位置pn(xn0,yn0,zn0),其中n为剩余三坐标数控定位器的编号;

步骤七:根据飞机大部件在飞机坐标系下位姿调整,获取步骤5中所述三坐标数控定位器的球窝中心在飞机坐标系下的目标位置p1’(x10’,y10’,z10’),通过如下位置逆解公式计算出该三坐标数控定位器的物理轴所需要的移动量(δx1m,δy1m,δz1m):

m=v1xx*v1yy*v1zz v1xy*v1yz*v1zx v1xz*v1yx*v1zy-v1xx*v1yz*v1zy-v1xy*v1yx*v1zz-v1xz*v1yy*v1zx;

mx=(x’10-x10)*v1yy*v1zz (y’10-y10)*v1yz*v1zx (z’10-z10)*v1yx*v1zx-(x’10-x10)*v1yz*v1zy-(y’10-y10)*v1yx*v1zz-(z’10-z10)*v1yy*v1zx;

my=(y’10-y10)*v1xx*v1zz (z’10-z10)*v1xy*v1zx (x’10-x10)*v1xz*v1zy-(z’10-z10)*v1xx*v1zy-(x’10-x10)*v1xy*v1zz-(y’10-y10)*v1xz*v1zx;

mz=(z’10-z10)*v1xx*v1yy (x’10-x10)*v1xy*v1yz (y’10-y10)*v1xz*v1yx-(y’10-y10)*v1xx*v1yz-(z’10-z10)*v1xy*v1yx-(x’10-x10)*v1xz*v1yy;

则得出:δx1m=mx/m,δy1m=my/m,δz1m=mz/m。

步骤八:重复步骤七,获取其余三坐标数控定位器的球窝中心在飞机坐标系下的目标位置pn’(xn0’,yn0’,zn0’),并按照步骤七中位置逆解公式计算得到其余三坐标数控定位器的物理轴所需要的移动量(δxnm,δynm,δznm),其中n为剩余三坐标数控定位器的编号。

步骤九:将各三坐标数控定位器物理轴的移动量下发至运动控制器,运动控制器驱动三坐标数控定位器所有运动轴同步运动,实现飞机大部件的位姿调整。

本发明通过将多个三坐标数控定位器组成一套调姿对合系统,建立调姿对合系统的飞机坐标系,并通过激光跟踪仪获取三坐标数控定位器在飞机坐标系下定位器的空间位置和定位器x、y、z物理轴的轴线方向数据,进而根据调姿对合系统在飞机坐标系下的平移、旋转运动并通过位置逆解获取各三坐标数控定位器物理轴的位移增量,以实现飞机大部件的位置姿态调整。

本发明基于数学方式进行精确计算,即每个三坐标数控定位器均通过位置逆解公式计算出该三坐标数控定位器的物理轴所需要的移动量,精确度高,仅需大致保证三坐标数控定位器和飞机坐标系的平行度即可,无需耗费大量人力物力来实现三坐标数控定位器的几何调试,然后将各三坐标数控定位器物理轴的移动量下发至运动控制器,运动控制器驱动三坐标数控定位器所有运动轴同步运动,实现飞机大部件的位姿调整,且在三坐标数控定位器使用一段时间后,仅需重新标定各物理轴轴线的方向向量即可实现几何精度的修正,无需再进行几何精度调整。因此本发明具有操作性强、精度及可靠性高、通用性好、可维护性好、实用性高等优点。

具体地,在步骤一中,确定y轴时采用以下方法:

以同一列定位器安装板中心点连线所构成的中心线作为飞机坐标系的y轴。

具体地,在步骤一中,通过在平台上放置水平仪以实现所述获取水平面作为飞机坐标系的xy平面。

具体地,在步骤一中,通过右手定则以实现所述获取飞机坐标系的x轴及z轴并确定飞机坐标系的原点o(x0,y0,z0),所述右手定则为:以右手握住z轴,当右手的四指从正向x轴以π/2角度转向正向y轴时,大拇指的指向即z轴的正向。

此处已经确定了xy平面及y轴,按照右手定则即可确定x轴和z轴,判断方法简单有效。

具体地,在步骤二至步骤四中,所述多个不同位置为不少于10个的不同位置,保证测试的精确度。

具体地,三坐标数控定位器的数量为4m个,m为由1开始的自然数。这里三坐标数控定位器的数量以飞机大部件段数为准,每一段飞机大部件均采用4个三坐标数控定位器。

实施例2

如图1-2所示,本实施例是在实施例1的基础上,以单段飞机大部件调姿4台三坐标数控定位器组为例,提供一种多数控定位器物理空间任意轴线的坐标变换方法,具体包含以下步骤:

步骤一:建立全局飞机坐标系,分别将三坐标数控定位器1、2、3、4安放在定位器安装板上,以三坐标数控定位器1、4的安装板中心点连线和三坐标数控定位器2、3的安装板中心点连线所构成的中心线作为飞机坐标系的y轴,在平台上放置水平仪获取水平面作为飞机坐标系的xy平面,以右手定则获取飞机坐标系的x轴及z轴并确定飞机坐标系的原点o(x0,y0,z0);

步骤二:移动三坐标数控定位器1的x轴处于不少于10个位置,激光跟踪仪测量不同位置处的坐标数据并通过激光跟踪仪直线拟合确定三坐标数控定位器1的x轴轴线向量(v1xx,v1xy,v1xz);

步骤三:移动三坐标数控定位器1的y轴处于不少于10个位置,激光跟踪仪测量不同位置处的坐标数据并通过激光跟踪仪直线拟合确定三坐标数控定位器1的y轴轴线向量(v1yx,v1yy,v1yz);

步骤四:移动三坐标数控定位器1的z轴处于不少于10个位置,激光跟踪仪测量不同位置处的坐标数据并通过激光跟踪仪直线拟合确定三坐标数控定位器1的z轴轴线向量(v1zx,v1zy,v1zz);

步骤五:移动数控定位器各轴回到初始位置处,拟合数控定位器球窝中心点获取其在飞机坐标系下的初始位置p1(x10,y10,z10);

步骤六:重复步骤二至步骤五获取三坐标数控定位器2、3、4的x轴轴线向量分别为(v2xx,v2xy,v2xz)、(v3xx,v3xy,v3xz)、(v4xx,v4xy,v4xz),并获取三坐标数控定位器2、3、4的y轴轴线向量分别为(v2yx,v2yy,v2yz)、(v3yx,v3yy,v3yz)、(v4yx,v4yy,v4yz),并获取三坐标数控定位器2、3、4的z轴轴线向量分别为(v2zx,v2zy,v2zz)、(v3zx,v3zy,v3zz)、(v4zx,v4zy,v4zz)以及三坐标数控定位器2、3、4的初始位置分别为p2(x20,y20,z20)、p3(x30,y30,z30)、p4(x40,y40,z40);

步骤七:根据飞机大部件在飞机坐标系下位姿调整,获取三坐标数控定位器1的球窝中心在飞机坐标系下的目标位置p1’(x10’,y10’,z10’),通过如下位置逆解公式计算的三坐标数控定位器1的物理轴所需要的移动量(δx1m,δy1m,δz1m):

m=v1xx*v1yy*v1zz v1xy*v1yz*v1zx v1xz*v1yx*v1zy-v1xx*v1yz*v1zy-v1xy*v1yx*v1zz-v1xz*v1yy*v1zx;

mx=(x’10-x10)*v1yy*v1zz (y’10-y10)*v1yz*v1zx (z’10-z10)*v1yx*v1zx-(x’10-x10)*v1yz*v1zy-(y’10-y10)*v1yx*v1zz-(z’10-z10)*v1yy*v1zx;

my=(y’10-y10)*v1xx*v1zz (z’10-z10)*v1xy*v1zx (x’10-x10)*v1xz*v1zy-(z’10-z10)*v1xx*v1zy-(x’10-x10)*v1xy*v1zz-(y’10-y10)*v1xz*v1zx;

mz=(z’10-z10)*v1xx*v1yy (x’10-x10)*v1xy*v1yz (y’10-y10)*v1xz*v1yx-(y’10-y10)*v1xx*v1yz-(z’10-z10)*v1xy*v1yx-(x’10-x10)*v1xz*v1yy;

则得出:δx1m=mx/m,δy1m=my/m,δz1m=mz/m。

步骤八:根据飞机大部件在飞机坐标系下位姿调整,重复步骤七,获取数控定位器2、3、4的球窝中心在飞机坐标系下的目标位置分别为p2’(x20’,y20’,z20’)、p3’(x30’,y30’,z30’)、p4’(x40’,y40’,z40’),并按照步骤七中位置逆解公式计算得到三坐标数控定位器2、3、4的物理轴所需要的移动量分别为(δx2m,δy2m,δz2m)、(δx3m,δy3m,δz3m)、(δx4m,δy4m,δz4m)。

步骤九:将各数控定位器物理轴的移动量下发至运动控制器,运动控制器驱动三坐标数控定位器所有运动轴同步运动,实现飞机大部件的位姿调整。

最后应说明的是:以上各实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述各实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的范围,其均应涵盖在本发明的权利要求和说明书的范围当中。

再多了解一些

本文用于企业家、创业者技术爱好者查询,结果仅供参考。

发表评论 共有条评论
用户名: 密码:
验证码: 匿名发表

相关文章

  • 日榜
  • 周榜
  • 月榜