CN118239003A - Component posture adjustment and alignment method without fixed measuring field, storage medium and control system - Google Patents
Component posture adjustment and alignment method without fixed measuring field, storage medium and control system Download PDFInfo
- Publication number
- CN118239003A CN118239003A CN202410677004.7A CN202410677004A CN118239003A CN 118239003 A CN118239003 A CN 118239003A CN 202410677004 A CN202410677004 A CN 202410677004A CN 118239003 A CN118239003 A CN 118239003A
- Authority
- CN
- China
- Prior art keywords
- posture adjustment
- adjustment
- large component
- posture
- alignment
- 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
- 238000000034 method Methods 0.000 title claims abstract description 48
- 238000003860 storage Methods 0.000 title claims abstract description 24
- 238000005259 measurement Methods 0.000 claims abstract description 51
- 238000013519 translation Methods 0.000 claims description 89
- 239000013598 vector Substances 0.000 claims description 43
- 230000009466 transformation Effects 0.000 claims description 20
- 230000008569 process Effects 0.000 claims description 17
- 238000004891 communication Methods 0.000 claims description 9
- 238000004364 calculation method Methods 0.000 claims description 5
- 238000004519 manufacturing process Methods 0.000 abstract description 5
- 239000011159 matrix material Substances 0.000 description 10
- 238000005457 optimization Methods 0.000 description 5
- 101001121408 Homo sapiens L-amino-acid oxidase Proteins 0.000 description 3
- 102100026388 L-amino-acid oxidase Human genes 0.000 description 3
- 101100233916 Saccharomyces cerevisiae (strain ATCC 204508 / S288c) KAR5 gene Proteins 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000012417 linear regression Methods 0.000 description 2
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 description 1
- 101000827703 Homo sapiens Polyphosphoinositide phosphatase Proteins 0.000 description 1
- 102100023591 Polyphosphoinositide phosphatase Human genes 0.000 description 1
- 238000012356 Product development Methods 0.000 description 1
- 101100012902 Saccharomyces cerevisiae (strain ATCC 204508 / S288c) FIG2 gene Proteins 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000000354 decomposition reaction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64F—GROUND OR AIRCRAFT-CARRIER-DECK INSTALLATIONS SPECIALLY ADAPTED FOR USE IN CONNECTION WITH AIRCRAFT; DESIGNING, MANUFACTURING, ASSEMBLING, CLEANING, MAINTAINING OR REPAIRING AIRCRAFT, NOT OTHERWISE PROVIDED FOR; HANDLING, TRANSPORTING, TESTING OR INSPECTING AIRCRAFT COMPONENTS, NOT OTHERWISE PROVIDED FOR
- B64F5/00—Designing, manufacturing, assembling, cleaning, maintaining or repairing aircraft, not otherwise provided for; Handling, transporting, testing or inspecting aircraft components, not otherwise provided for
- B64F5/10—Manufacturing or assembling aircraft, e.g. jigs therefor
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Transportation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Image Analysis (AREA)
Abstract
Description
技术领域Technical Field
本发明属于部件对合装配的技术领域,涉及无固定测量场的部件调姿对合方法、储存介质、控制系统。The invention belongs to the technical field of component matching and assembly, and relates to a component posture adjustment matching method without a fixed measurement field, a storage medium, and a control system.
背景技术Background technique
随着数字化工厂技术的快速发展,飞机部件的装配越来越多地使用数字化设备系统,这样可以大大提高飞机部件的装配效率及装配精度和质量。目前,在国内外飞机大部件数字化调姿对合装配领域,随着飞机产品研制更新迭代的加速、装配制造需求的提升,解决当前普遍存在的一型飞机产品对应一套专用调姿对合设备和专用测量场的局限问题,探索如何适应各型飞机产品快速进行数字化装配的实现方法至关重要。With the rapid development of digital factory technology, the assembly of aircraft parts is increasingly using digital equipment systems, which can greatly improve the assembly efficiency, assembly accuracy and quality of aircraft parts. At present, in the field of digital attitude adjustment and assembly of large aircraft parts at home and abroad, with the acceleration of aircraft product development and iteration, and the increase in assembly and manufacturing needs, it is crucial to solve the current common limitation of one set of dedicated attitude adjustment equipment and dedicated measurement field for one type of aircraft product, and explore how to adapt to the implementation method of rapid digital assembly of various types of aircraft products.
传统的飞机大部件数字化调姿对合,是在装配现场确定出理论飞机坐标系,现场所有的调姿设备、测量场、飞机大部件都要在理论飞机坐标系下按照各自数模理论位姿进行精确安装,并将飞机大部件数模中的理论特征作为调姿目标位置进行调姿对合工作。当更换另外一型飞机大部件需进行调姿对合时,就需要重新现场确定当前机型的理论飞机坐标系,并重新安装确定或标定调姿设备、测量场、飞机大部件的位姿,重新从数模获取部件调姿目标理论位置,这种调姿对合全局要素都基于理论离线数模的数字化调姿方式,制约了飞机产品更新制造的效率,已无法满足各型飞机快速数字化装配的需求。The traditional digital attitude adjustment and alignment of large aircraft components is to determine the theoretical aircraft coordinate system at the assembly site. All attitude adjustment equipment, measurement fields, and large aircraft components on site must be accurately installed according to the theoretical posture of their respective digital models under the theoretical aircraft coordinate system, and the theoretical features in the digital model of the large aircraft components are used as the attitude adjustment target position for attitude adjustment and alignment. When replacing another type of large aircraft component and requiring attitude adjustment and alignment, it is necessary to re-determine the theoretical aircraft coordinate system of the current model on site, and re-install and determine or calibrate the attitude adjustment equipment, measurement field, and large aircraft components, and re-obtain the component attitude adjustment target theoretical position from the digital model. This attitude adjustment and alignment global elements are based on the digital attitude adjustment method of the theoretical offline digital model, which restricts the efficiency of aircraft product update and manufacturing, and can no longer meet the needs of rapid digital assembly of various types of aircraft.
因此,针对现有的飞机大部件数字化调姿对合过程中存在的上述缺陷,本发明公开了无固定测量场的部件调姿对合方法、储存介质、控制系统。Therefore, in view of the above-mentioned defects existing in the existing digital attitude adjustment and alignment process of large aircraft components, the present invention discloses a component attitude adjustment and alignment method, storage medium and control system without a fixed measurement field.
发明内容Summary of the invention
本发明的目的在于提供无固定测量场的部件调姿对合方法、储存介质、控制系统,能够摆脱现有技术中飞机大部件数字化调姿对合对于固定测量场、理论飞机坐标系、理论特征目标位置及设备轴向与飞机坐标系一致性的依赖,解决当前调姿对合系统无法快速适应各型飞机大部件、适应部件制造形状误差进行数字化调姿对合的问题。The purpose of the present invention is to provide a component attitude adjustment method, storage medium, and control system without a fixed measurement field, which can get rid of the reliance of the digital attitude adjustment of large aircraft components in the prior art on the fixed measurement field, theoretical aircraft coordinate system, theoretical characteristic target position, and consistency between the equipment axis and the aircraft coordinate system, and solve the problem that the current attitude adjustment system cannot quickly adapt to various types of large aircraft components and adapt to component manufacturing shape errors for digital attitude adjustment.
本发明通过下述技术方案实现:The present invention is achieved through the following technical solutions:
无固定测量场的部件调姿对合方法,基于调姿对合设备实现调姿大部件与目标大部件的对合,包括以下步骤:A component posture adjustment and alignment method without a fixed measurement field realizes the alignment of a posture adjustment large component with a target large component based on a posture adjustment and alignment device, and includes the following steps:
步骤1、将调姿大部件放置在调姿对合设备上,并在调姿大部件上建立调姿特征点,通过调姿对合设备带动调姿大部件进行平移和旋转运动,在调姿大部件运动过程中测量调姿大部件上的调姿特征点的实时位置;Step 1, place the posture adjustment large component on the posture adjustment matching device, and establish posture adjustment feature points on the posture adjustment large component, drive the posture adjustment large component to perform translation and rotation movements through the posture adjustment matching device, and measure the real-time positions of the posture adjustment feature points on the posture adjustment large component during the movement of the posture adjustment large component;
步骤2、基于调姿大部件平移过程中测量的调姿特征点的实时位置,拟合平移轴线;基于调姿大部件旋转过程中测量的调姿特征点的实时位置,拟合旋转中心;基于平移轴线与旋转中心建立调姿对合坐标系;Step 2: Fit the translation axis based on the real-time position of the posture feature points measured during the translation of the posture large component; fit the rotation center based on the real-time position of the posture feature points measured during the rotation of the posture large component; establish a posture alignment coordinate system based on the translation axis and the rotation center;
步骤3、在调姿对合坐标系下,在目标大部件与调姿大部件上建立对合特征位置,基于目标大部件上的对合特征位置与调姿大部件上的对合特征位置进行迭代位姿拟合,求解调姿大部件相对于目标大部件移动对合的平移参数、旋转参数、尺度缩放参数;Step 3: In the pose adjustment coordinate system, establish the alignment feature positions on the target large component and the pose adjustment large component, perform iterative pose fitting based on the alignment feature positions on the target large component and the alignment feature positions on the pose adjustment large component, and solve the translation parameters, rotation parameters, and scale scaling parameters of the pose adjustment large component relative to the target large component;
步骤4、根据步骤3中得到的平移参数、旋转参数、尺度缩放参数控制调姿对合设备带动调姿大部件相对于目标大部件进行移动对合。Step 4: According to the translation parameters, rotation parameters, and scale parameters obtained in step 3, the posture adjustment and alignment equipment is controlled to drive the posture adjustment large component to move and align relative to the target large component.
为了更好地实现本发明,进一步的,所述步骤3具体包括:In order to better implement the present invention, further, the step 3 specifically includes:
步骤3.1、基于对合特征位置在目标大部件与调姿大部件上建立若干基准钉点,求解调姿大部件上的基准钉点移动对合至目标大部件上的基准钉点的平移参数、旋转参数,并将求解的平移参数、旋转参数作为ICP迭代运算的初始值;Step 3.1, based on the aligned feature positions, establish several reference pin points on the target large part and the posture adjustment large part, solve the translation parameters and rotation parameters of the reference pin points on the posture adjustment large part to move and align to the reference pin points on the target large part, and use the solved translation parameters and rotation parameters as the initial values of the ICP iterative operation;
步骤3.2、基于调姿大部件上的基准钉点与目标大部件上的基准钉点之间的基准残差,对各个基准钉点进行加权中心化;Step 3.2, based on the reference residual between the reference pin point on the pose adjustment large part and the reference pin point on the target large part, weighted centralization is performed on each reference pin point;
步骤3.3、基于加权中心化之后的基准钉点建立SVD调姿模型,通过SVD调姿模型对平移参数、旋转参数进行优化;Step 3.3, establish an SVD posture adjustment model based on the weighted central reference pin points, and optimize the translation parameters and rotation parameters through the SVD posture adjustment model;
步骤3.4、重复迭代进行步骤3.1-步骤3.3,直到目标大部件与调姿大部件上的对合特征位置的方差收敛,导出此时的平移参数、旋转参数;Step 3.4, repeat steps 3.1 to 3.3 iteratively until the variance of the aligned feature positions on the target large part and the posture adjustment large part converges, and derive the translation parameters and rotation parameters at this time;
步骤3.5、基于步骤3.4中得到的平移参数、旋转参数建立尺度缩放参数的平差模型,基于尺度缩放参数的平差模型解算尺度缩放参数。Step 3.5: Establish an adjustment model for scale parameters based on the translation parameters and rotation parameters obtained in step 3.4, and calculate the scale parameters based on the adjustment model for scale parameters.
为了更好地实现本发明,进一步的,所述基准残差包括工艺允差与位姿方差。In order to better implement the present invention, further, the reference residual includes process tolerance and posture variance.
为了更好地实现本发明,进一步的,若目标大部件上的对合特征位置与调姿大部件上的对合特征位置之间的形状误差参数在工艺允差范围之内,则步骤3.4通过迭代求解满足所有工艺允差范围的可行解作为平移参数、旋转参数;若目标大部件上的对合特征位置与调姿大部件上的对合特征位置之间的形状误差参数在超出工艺允差范围,则步骤3.4通过迭代求解全局最优解作为平移参数、旋转参数。In order to better realize the present invention, further, if the shape error parameters between the matching feature positions on the target large component and the matching feature positions on the posture adjustment large component are within the process tolerance range, then step 3.4 iteratively solves the feasible solution that satisfies all process tolerance ranges as the translation parameters and rotation parameters; if the shape error parameters between the matching feature positions on the target large component and the matching feature positions on the posture adjustment large component are beyond the process tolerance range, then step 3.4 iteratively solves the global optimal solution as the translation parameters and rotation parameters.
为了更好地实现本发明,进一步的,所述形状误差参数为目标大部件上的对合特征位置与调姿大部件上的对合特征位置进行形状误差拟合后得到的理想调姿误差边界,或所述形状误差参数为调姿大部件上的基准钉点与目标大部件上的基准钉点之间的基准残差。In order to better realize the present invention, further, the shape error parameter is an ideal attitude adjustment error boundary obtained after shape error fitting of the matching feature position on the target large component and the matching feature position on the attitude adjustment large component, or the shape error parameter is a reference residual between the reference pin point on the attitude adjustment large component and the reference pin point on the target large component.
为了更好地实现本发明,进一步的,所述步骤2具体包括:In order to better implement the present invention, further, the step 2 specifically includes:
步骤2.1、通过调姿对合设备带动调姿大部件沿第一方向平移,在调姿大部件沿第一方向平移的过程中,测量调姿大部件上的调姿特征点的实时位置坐标,并根据实时位置坐标拟合得到第一平移轴,求解第一平移轴的第一方向矢量;Step 2.1, driving the posture adjustment large component to translate along the first direction through the posture adjustment and alignment device, measuring the real-time position coordinates of the posture adjustment feature points on the posture adjustment large component during the translation of the large component along the first direction, and obtaining the first translation axis by fitting according to the real-time position coordinates, and solving the first direction vector of the first translation axis;
步骤2.2、通过调姿对合设备带动调姿大部件沿第二方向平移,在调姿大部件朝向第二方向平移的过程中,测量调姿大部件上的调姿特征点的实时位置坐标,并根据实时位置坐标拟合得到第二平移轴,求解第二平移轴的第二方向矢量;Step 2.2, driving the posture adjustment large component to translate along the second direction by the posture adjustment and alignment device, measuring the real-time position coordinates of the posture adjustment feature points on the posture adjustment large component during the translation of the posture adjustment large component toward the second direction, and obtaining the second translation axis according to the real-time position coordinates, and solving the second direction vector of the second translation axis;
步骤2.3、对第一方向矢量和第二方向矢量进行叉积运算,求解第三方向矢量;Step 2.3, performing a cross product operation on the first direction vector and the second direction vector to obtain the third direction vector;
步骤2.4、通过调姿对合设备带动调姿大部件进行若干方向的旋转,在调姿大部件朝向若干方向旋转的过程中,测量调姿大部件上的调姿特征点的实时位置坐标,并根据实时位置坐标拟合球面方程,根据球面方程求解旋转中心;Step 2.4, the posture adjustment large component is driven to rotate in several directions by the posture adjustment matching device. During the rotation of the posture adjustment large component in several directions, the real-time position coordinates of the posture adjustment feature points on the posture adjustment large component are measured, and the spherical equation is fitted according to the real-time position coordinates, and the rotation center is solved according to the spherical equation;
步骤2.5、将第一方向矢量作为Y向,将第二方向矢量作为Z向,将第三方向矢量作为X向,将旋转中心作为原点,进而建立调姿对合坐标系。Step 2.5: Use the first direction vector as the Y direction, the second direction vector as the Z direction, the third direction vector as the X direction, and the rotation center as the origin to establish a posture adjustment coordinate system.
无固定测量场的部件调姿对合存储介质,所述存储介质中存储用于实现无固定测量场的大部件调姿对合方法的操作系统。A storage medium for component posture adjustment and alignment without a fixed measurement field is provided, wherein the storage medium stores an operating system for implementing a method for large component posture adjustment and alignment without a fixed measurement field.
为了更好地实现本发明,进一步的,所述操作系统包括操作模块、运动后置解算模块、调姿对合坐标系创建模块、测量设备控制模块、位姿拟合变换运算模块、调姿对合设备控制模块,所述操作模块用于执行实现无固定测量场的大部件调姿对合方法的程序代码;所述运动后置解算模块用于控制调姿对合设备中的数控定位器按照规划路径运动;所述调姿对合坐标系创建模块用于创建调姿对合坐标系;所述测量设备控制模块用于控制测量设备对调姿特征点的实时位置进行测量;所述位姿拟合变换运算模块用于求解调姿大部件相对于目标大部件移动对合的平移参数、旋转参数、尺度缩放参数;所述调姿对合设备控制模块用于连接并控制调姿对合设备。In order to better realize the present invention, further, the operating system includes an operation module, a motion post-solving module, a posture adjustment coordinate system creation module, a measuring device control module, a posture fitting transformation operation module, and a posture adjustment device control module. The operation module is used to execute a program code for implementing a large component posture adjustment method without a fixed measurement field; the motion post-solving module is used to control the CNC positioner in the posture adjustment device to move according to a planned path; the posture adjustment coordinate system creation module is used to create a posture adjustment coordinate system; the measuring device control module is used to control the measuring device to measure the real-time position of the posture feature point; the posture fitting transformation operation module is used to solve the translation parameters, rotation parameters, and scale scaling parameters of the posture adjustment large component relative to the target large component; the posture adjustment device control module is used to connect and control the posture adjustment device.
无固定测量场的部件调姿对合控制系统,包括存储介质,还包括处理器、通信总线、调姿对合设备接口、测量设备接口,所述处理器通过通信总线分别与调姿对合设备接口、测量设备接口、存储介质连接,所述调姿对合设备接口与调姿对合设备连接,所述测量设备接口与测量设备连接。A component attitude adjustment and alignment control system without a fixed measurement field includes a storage medium, a processor, a communication bus, an attitude adjustment and alignment device interface, and a measuring device interface. The processor is connected to the attitude adjustment and alignment device interface, the measuring device interface, and the storage medium respectively through the communication bus, the attitude adjustment and alignment device interface is connected to the attitude adjustment and alignment device, and the measuring device interface is connected to the measuring device.
本发明与现有技术相比,具有以下优点及有益效果:Compared with the prior art, the present invention has the following advantages and beneficial effects:
本发明利用大部件随调姿设备初始运动来在线创建测量及调姿基准坐标系,并以目标大部件、调姿大部件实测特征分别作为调姿目标位置与当前位置,将调姿大部件位姿调整至目标大部件对合位置,摆脱了传统调姿对合方式对于理论飞机坐标系、现场固定测量场、数模调姿目标位置及设备轴向与飞机坐标系一致性的依赖,能够快速在线适应不同飞机大部件的数字化调姿对合工作,解决当前普遍存在的一型飞机产品对应一套专用调姿对合设备和专用测量场的局限问题,满足了各型飞机产品更新迭代及高效数字化装配制造的需求。The present invention utilizes the initial movement of large components with the attitude adjustment equipment to create a measurement and attitude adjustment reference coordinate system online, and uses the target large component and the measured features of the attitude adjustment large component as the attitude adjustment target position and the current position respectively, and adjusts the posture of the attitude adjustment large component to the target large component matching position, thereby getting rid of the dependence of the traditional attitude adjustment matching method on the theoretical aircraft coordinate system, the on-site fixed measurement field, the digital model attitude adjustment target position and the consistency of the equipment axis with the aircraft coordinate system, and can quickly adapt to the digital attitude adjustment matching work of different large aircraft components online, solving the current widespread limitation that one type of aircraft product corresponds to a set of dedicated attitude adjustment matching equipment and a dedicated measurement field, and meeting the needs of various types of aircraft product updates and iterations and efficient digital assembly and manufacturing.
附图说明BRIEF DESCRIPTION OF THE DRAWINGS
图1为无固定测量场的部件调姿对合方法的步骤流程示意图;FIG1 is a schematic flow chart of the steps of a method for adjusting the posture of a component without a fixed measurement field;
图2为无固定测量场的部件调姿对合方法的具体流程框图;FIG2 is a specific flow chart of a method for adjusting the posture of a component without a fixed measurement field;
图3为无固定测量场的部件调姿对合控制系统的示意图;FIG3 is a schematic diagram of a component posture adjustment control system without a fixed measurement field;
图4为目标大部件与调姿大部件对合的示意图。FIG. 4 is a schematic diagram showing the alignment of the target large component and the posture adjustment large component.
其中:101-处理器;102-通信总线;103-调姿对合设备接口;104-测量设备接口;201-操作模块;202-运动后置解算模块;203-调姿对合坐标系创建模块;204-测量设备控制模块;205-位姿拟合变换运算模块;206-调姿对合设备控制模块。Among them: 101-processor; 102-communication bus; 103-attitude adjustment and matching device interface; 104-measurement device interface; 201-operation module; 202-motion post-calculation module; 203-attitude adjustment and matching coordinate system creation module; 204-measurement device control module; 205-posture fitting transformation operation module; 206-attitude adjustment and matching device control module.
具体实施方式Detailed ways
以下详细说明都是例示性的,旨在对本发明提供进一步的说明。除非另有指明,本发明使用的所有技术和科学术语具有与本发明所属技术领域的普通技术人员通常理解的相同含义。The following detailed descriptions are all illustrative and are intended to provide further explanation of the present invention. Unless otherwise specified, all technical and scientific terms used in the present invention have the same meanings as those commonly understood by those skilled in the art to which the present invention belongs.
需注意的是,这里所使用的术语仅是为了描述具体实施方式,而非意图限制根据本发明的示例性实施方式。如在这里所使用的,除非本发明另外明确指出,否则单数形式也意图包括复数形式,此外,还应当理解的是,当在本说明书中使用术语“包含”和/或“包括”时,其指明存在特征、步骤、操作、器件、组件和/或它们的组合。It should be noted that the terms used herein are only for describing specific embodiments and are not intended to limit exemplary embodiments according to the present invention. As used herein, unless the present invention explicitly states otherwise, singular forms are also intended to include plural forms. In addition, it should be understood that when the terms "comprising" and/or "including" are used in this specification, it indicates the presence of features, steps, operations, devices, components and/or combinations thereof.
为方便叙述,本发明中如果出现“上”、“下”、“左”“右”字样,仅表示与附图本身的上、下、左、右方向一致,并不对结构起限定作用,仅仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的设备或元件必须具有特定的方位,以特定的方位构造和操作,因此不能理解为对本发明的限制。For the convenience of description, if the words "up", "down", "left" and "right" appear in the present invention, they only indicate that they are consistent with the up, down, left and right directions of the drawings themselves, and do not limit the structure. They are only for the convenience of describing the present invention and simplifying the description, rather than indicating or implying that the referred device or element must have a specific orientation, be constructed and operated in a specific orientation. Therefore, it cannot be understood as a limitation on the present invention.
术语解释部分:本发明中的术语“安装”、“相连”、“连接”、“固定”等术语应做广义理解,例如,可以是固定连接,也可以是可拆卸连接,或为一体;可以是机械连接,也可以是电连接,可以是直接连接,也可以是通过中间媒介间接相连,可以是两个元件内部连接,或者两个元件的相互作用关系,对于本领域的普通技术人员而言,可以根据具体情况理解上述术语在本发明的具体含义。Terminology explanation section: The terms "install", "connect", "connect", "fixed" and the like in the present invention should be understood in a broad sense. For example, it can be a fixed connection, a detachable connection, or an integrated connection; it can be a mechanical connection or an electrical connection; it can be a direct connection or an indirect connection through an intermediate medium; it can be an internal connection between two elements, or an interaction relationship between two elements. For ordinary technicians in this field, the specific meanings of the above terms in the present invention can be understood according to the specific circumstances.
实施例1:Embodiment 1:
本实施例的无固定测量场的部件调姿对合方法,如图1和图4所示,包括以下步骤:The component posture adjustment and alignment method without a fixed measurement field of this embodiment, as shown in FIG1 and FIG4 , includes the following steps:
步骤1、将调姿大部件放置在调姿对合设备上,并在调姿大部件上建立调姿特征点,通过调姿对合设备带动调姿大部件进行平移和旋转运动,在调姿大部件运动过程中测量调姿大部件上的调姿特征点的实时位置;Step 1, place the posture adjustment large component on the posture adjustment matching device, and establish posture adjustment feature points on the posture adjustment large component, drive the posture adjustment large component to perform translation and rotation movements through the posture adjustment matching device, and measure the real-time positions of the posture adjustment feature points on the posture adjustment large component during the movement of the posture adjustment large component;
步骤2、基于调姿大部件平移过程中测量的调姿特征点的实时位置,拟合平移轴线;基于调姿大部件旋转过程中测量的调姿特征点的实时位置,拟合旋转中心;基于平移轴线与旋转中心建立调姿对合坐标系;Step 2: Fit the translation axis based on the real-time position of the posture feature points measured during the translation of the posture large component; fit the rotation center based on the real-time position of the posture feature points measured during the rotation of the posture large component; establish a posture alignment coordinate system based on the translation axis and the rotation center;
步骤3、在调姿对合坐标系下,在目标大部件与调姿大部件上建立对合特征位置,基于目标大部件上的对合特征位置与调姿大部件上的对合特征位置进行迭代位姿拟合,求解调姿大部件相对于目标大部件移动对合的平移参数、旋转参数、尺度缩放参数;Step 3: In the pose adjustment coordinate system, establish the alignment feature positions on the target large component and the pose adjustment large component, perform iterative pose fitting based on the alignment feature positions on the target large component and the alignment feature positions on the pose adjustment large component, and solve the translation parameters, rotation parameters, and scale scaling parameters of the pose adjustment large component relative to the target large component;
步骤4、根据步骤3中得到的平移参数、旋转参数、尺度缩放参数控制调姿对合设备带动调姿大部件相对于目标大部件进行移动对合。Step 4: According to the translation parameters, rotation parameters, and scale parameters obtained in step 3, the posture adjustment and alignment equipment is controlled to drive the posture adjustment large component to move and align relative to the target large component.
步骤2具体包括:Step 2 specifically includes:
步骤2.1、通过调姿对合设备带动调姿大部件沿第一方向平移,在调姿大部件沿第一方向平移的过程中,测量调姿大部件上的调姿特征点的实时位置坐标,并根据实时位置坐标拟合得到第一平移轴,求解第一平移轴的第一方向矢量;Step 2.1, driving the posture adjustment large component to translate along the first direction through the posture adjustment and alignment device, measuring the real-time position coordinates of the posture adjustment feature points on the posture adjustment large component during the translation of the large component along the first direction, and obtaining the first translation axis by fitting according to the real-time position coordinates, and solving the first direction vector of the first translation axis;
步骤2.2、通过调姿对合设备带动调姿大部件沿第二方向平移,在调姿大部件朝向第二方向平移的过程中,测量调姿大部件上的调姿特征点的实时位置坐标,并根据实时位置坐标拟合得到第二平移轴,求解第二平移轴的第二方向矢量;Step 2.2, driving the posture adjustment large component to translate along the second direction by the posture adjustment and alignment device, measuring the real-time position coordinates of the posture adjustment feature points on the posture adjustment large component during the translation of the posture adjustment large component toward the second direction, and obtaining the second translation axis according to the real-time position coordinates, and solving the second direction vector of the second translation axis;
步骤2.3、对第一方向矢量和第二方向矢量进行叉积运算,求解第三方向矢量;Step 2.3, performing a cross product operation on the first direction vector and the second direction vector to obtain the third direction vector;
步骤2.4、通过调姿对合设备带动调姿大部件进行若干方向的旋转,在调姿大部件朝向若干方向旋转的过程中,测量调姿大部件上的调姿特征点的实时位置坐标,并根据实时位置坐标拟合球面方程,根据球面方程求解旋转中心;Step 2.4, the posture adjustment large component is driven to rotate in several directions by the posture adjustment matching device. During the rotation of the posture adjustment large component in several directions, the real-time position coordinates of the posture adjustment feature points on the posture adjustment large component are measured, and the spherical equation is fitted according to the real-time position coordinates, and the rotation center is solved according to the spherical equation;
步骤2.5、将第一方向矢量作为Y向,将第二方向矢量作为Z向,将第三方向矢量作为X向,将旋转中心作为原点,进而建立调姿对合坐标系。Step 2.5: Use the first direction vector as the Y direction, the second direction vector as the Z direction, the third direction vector as the X direction, and the rotation center as the origin to establish a posture adjustment coordinate system.
步骤3具体包括:Step 3 specifically includes:
步骤3.1、基于对合特征位置在目标大部件与调姿大部件上建立若干基准钉点,求解调姿大部件上的基准钉点移动对合至目标大部件上的基准钉点的平移参数、旋转参数,并将求解的平移参数、旋转参数作为ICP迭代运算的初始值;Step 3.1, based on the aligned feature positions, establish several reference pin points on the target large part and the posture adjustment large part, solve the translation parameters and rotation parameters of the reference pin points on the posture adjustment large part to move and align to the reference pin points on the target large part, and use the solved translation parameters and rotation parameters as the initial values of the ICP iterative operation;
步骤3.2、基于调姿大部件上的基准钉点与目标大部件上的基准钉点之间的基准残差,对各个基准钉点进行加权中心化;Step 3.2, based on the reference residual between the reference pin point on the pose adjustment large part and the reference pin point on the target large part, weighted centralization is performed on each reference pin point;
步骤3.3、基于加权中心化之后的基准钉点建立SVD调姿模型,通过SVD调姿模型对平移参数、旋转参数进行优化;Step 3.3, establish an SVD posture adjustment model based on the weighted central reference pin points, and optimize the translation parameters and rotation parameters through the SVD posture adjustment model;
步骤3.4、重复迭代进行步骤3.1-步骤3.3,直到目标大部件与调姿大部件上的对合特征位置的方差收敛,导出此时的平移参数、旋转参数;Step 3.4, repeat steps 3.1 to 3.3 iteratively until the variance of the aligned feature positions on the target large part and the posture adjustment large part converges, and derive the translation parameters and rotation parameters at this time;
步骤3.5、基于步骤3.4中得到的平移参数、旋转参数建立尺度缩放参数的平差模型,基于尺度缩放参数的平差模型解算尺度缩放参数。Step 3.5: Establish an adjustment model for scale parameters based on the translation parameters and rotation parameters obtained in step 3.4, and calculate the scale parameters based on the adjustment model for scale parameters.
进一步的,基准残差包括工艺允差与位姿方差。Furthermore, the benchmark residual includes process tolerance and pose variance.
进一步的,求解目标大部件上的对合特征位置与调姿大部件上的对合特征位置之间的形状误差参数,若形状误差参数在工艺允差范围之内,则步骤3.4通过迭代求解满足所有工艺允差范围的可行解作为平移参数、旋转参数;若目标大部件上的对合特征位置与调姿大部件上的对合特征位置之间的形状误差参数超出工艺允差范围,则步骤3.4通过迭代求解全局最优解作为平移参数、旋转参数。Furthermore, the shape error parameters between the matching feature positions on the target large component and the matching feature positions on the posture adjustment large component are solved. If the shape error parameters are within the process tolerance range, step 3.4 iteratively solves the feasible solution that satisfies all process tolerance ranges as the translation parameters and rotation parameters; if the shape error parameters between the matching feature positions on the target large component and the matching feature positions on the posture adjustment large component exceed the process tolerance range, step 3.4 iteratively solves the global optimal solution as the translation parameters and rotation parameters.
进一步的,形状误差参数为目标大部件上的对合特征位置与调姿大部件上的对合特征位置进行形状误差拟合后得到的理想调姿误差边界,或形状误差参数为调姿大部件上的基准钉点与目标大部件上的基准钉点之间的基准残差。Furthermore, the shape error parameter is an ideal attitude adjustment error boundary obtained after shape error fitting of the matching feature position on the target large component and the matching feature position on the attitude adjustment large component, or the shape error parameter is a reference residual between the reference pin point on the attitude adjustment large component and the reference pin point on the target large component.
实施例2:Embodiment 2:
本实施例的一种无固定测量场的大部件调姿对合的存储介质,如图3所示,存储介质中存储用于实现无固定测量场的大部件调姿对合方法的操作系统。A storage medium for large component posture adjustment and alignment without a fixed measurement field in this embodiment is shown in FIG3 . The storage medium stores an operating system for implementing a large component posture adjustment and alignment method without a fixed measurement field.
操作系统包括操作模块201、运动后置解算模块202、调姿对合坐标系创建模块203、测量设备控制模块204、位姿拟合变换运算模块205、调姿对合设备控制模块206,操作模块201用于执行实现无固定测量场的大部件调姿对合方法的程序代码;运动后置解算模块202用于控制调姿对合设备中的数控定位器按照规划路径运动;调姿对合坐标系创建模块203用于创建调姿对合坐标系;测量设备控制模块204用于控制测量设备对调姿特征点的实时位置进行测量;位姿拟合变换运算模块205用于求解调姿大部件相对于目标大部件移动对合的平移参数、旋转参数、尺度缩放参数;调姿对合设备控制模块206用于连接并控制调姿对合设备。The operating system includes an operation module 201, a motion post-solving module 202, a pose matching coordinate system creation module 203, a measuring device control module 204, a posture fitting transformation operation module 205, and a pose matching device control module 206. The operation module 201 is used to execute the program code for realizing a large component pose matching method without a fixed measurement field; the motion post-solving module 202 is used to control the CNC positioner in the pose matching device to move according to the planned path; the pose matching coordinate system creation module 203 is used to create the pose matching coordinate system; the measuring device control module 204 is used to control the measuring device to measure the real-time position of the pose feature point; the posture fitting transformation operation module 205 is used to solve the translation parameters, rotation parameters, and scale scaling parameters of the pose matching large component relative to the target large component; the pose matching device control module 206 is used to connect and control the pose matching device.
本实施例的其他部分与实施例1相同,故不再赘述。The other parts of this embodiment are the same as those of Embodiment 1, and thus will not be described in detail.
实施例3:Embodiment 3:
本实施例的一种无固定测量场的大部件调姿对合的控制系统,包括存储介质,还包括处理器101、通信总线102、调姿对合设备接口103、测量设备接口104,处理器101通过通信总线102分别与调姿对合设备接口103、测量设备接口104、存储介质连接,调姿对合设备接口103与调姿对合设备连接,测量设备接口104与测量设备连接。A control system for attitude adjustment and alignment of large components without a fixed measurement field in this embodiment includes a storage medium, a processor 101, a communication bus 102, an attitude adjustment and alignment device interface 103, and a measuring device interface 104. The processor 101 is connected to the attitude adjustment and alignment device interface 103, the measuring device interface 104, and the storage medium through the communication bus 102, the attitude adjustment and alignment device interface 103 is connected to the attitude adjustment and alignment device, and the measuring device interface 104 is connected to the measuring device.
本实施例的其他部分与实施例1或2相同,故不再赘述。The other parts of this embodiment are the same as those of Embodiment 1 or 2, and thus will not be described in detail.
实施例4:Embodiment 4:
本实施例的无固定测量场的部件调姿对合方法、存储介质、控制系统,参阅图1,无固定测量场的大部件调姿对合的控制系统,包括存储介质,还包括处理器101、通信总线102、调姿对合设备接口103、测量设备接口104,处理器101通过通信总线102分别与调姿对合设备接口103、测量设备接口104、存储介质连接,调姿对合设备接口103与调姿对合设备连接,测量设备接口104与测量设备连接。Referring to FIG1 , the method for attitude adjustment and alignment of components without a fixed measurement field in this embodiment, the storage medium, and the control system include a control system for attitude adjustment and alignment of large components without a fixed measurement field, including a storage medium, a processor 101, a communication bus 102, an attitude adjustment and alignment device interface 103, and a measuring device interface 104. The processor 101 is connected to the attitude adjustment and alignment device interface 103, the measuring device interface 104, and the storage medium through the communication bus 102, the attitude adjustment and alignment device interface 103 is connected to the attitude adjustment and alignment device, and the measuring device interface 104 is connected to the measuring device.
处理器101可以是中央处理器、网络处理器、数字信号处理器、集成电路、现场可编程门阵列、可编程逻辑器件、分立门、晶体管逻辑器件、分立硬件组件中的任意一种或几种的组合。The processor 101 may be any one or a combination of a central processing unit, a network processor, a digital signal processor, an integrated circuit, a field programmable gate array, a programmable logic device, a discrete gate, a transistor logic device, or discrete hardware components.
参阅图4,无固定测量场的大部件调姿存储介质,存储介质中存储用于实现无固定测量场的大部件调姿对合方法的操作系统;操作系统包括操作模块201、运动后置解算模块202、调姿对合坐标系创建模块203、测量设备控制模块204、位姿拟合变换运算模块205、调姿对合设备控制模块206,操作模块201用于执行实现无固定测量场的大部件调姿对合方法的程序代码;运动后置解算模块202用于控制调姿对合设备中的数控定位器按照规划路径运动;调姿对合坐标系创建模块203用于创建调姿对合坐标系;测量设备控制模块204用于控制测量设备对调姿特征点的实时位置进行测量;位姿拟合变换运算模块205用于求解调姿大部件相对于目标大部件移动对合的平移参数、旋转参数、尺度缩放参数;调姿对合设备控制模块206用于连接并控制调姿对合设备。Referring to FIG. 4 , a large component posture adjustment storage medium without a fixed measurement field stores an operating system for implementing a large component posture adjustment alignment method without a fixed measurement field; the operating system includes an operation module 201, a motion post-solving module 202, a posture adjustment alignment coordinate system creation module 203, a measurement device control module 204, a posture fitting transformation operation module 205, and a posture adjustment alignment device control module 206. The operation module 201 is used to execute a program code for implementing a large component posture adjustment alignment method without a fixed measurement field; the motion post-solving module 202 is used to control the CNC positioner in the posture adjustment alignment device to move according to a planned path; the posture adjustment alignment coordinate system creation module 203 is used to create a posture adjustment alignment coordinate system; the measurement device control module 204 is used to control the measurement device to measure the real-time position of the posture adjustment feature point; the posture fitting transformation operation module 205 is used to solve the translation parameters, rotation parameters, and scale scaling parameters of the posture adjustment large component relative to the target large component; and the posture adjustment alignment device control module 206 is used to connect and control the posture adjustment alignment device.
基于上述存储介质以及控制系统,提供无固定测量场的部件调姿对合方法:Based on the above storage medium and control system, a component posture adjustment method without a fixed measurement field is provided:
参照图1和图2,包括以下步骤:Referring to Figures 1 and 2, the process includes the following steps:
步骤1、将调姿大部件放置在调姿对合设备上,并在调姿大部件上建立调姿特征点,通过调姿对合设备带动调姿大部件进行平移和旋转运动,在调姿大部件运动过程中测量调姿大部件上的调姿特征点的实时位置。Step 1: Place the large posture adjustment component on the posture adjustment matching device, and establish posture adjustment feature points on the large posture adjustment component. The posture adjustment matching device drives the large posture adjustment component to perform translational and rotational movements, and measures the real-time positions of the posture adjustment feature points on the large posture adjustment component during the movement of the large posture adjustment component.
具体为:Specifically:
调姿对合设备根据大部件重心、可支撑位置及调姿对合行程确定目标大部件、调姿大部件的上架支撑位置,然后通过调姿对合设备控制模块206控制调姿对合设备移动至上架支撑位置,然后将目标大部件、调姿大部件分别吊装至对应的调姿对合设备上。保目标大部件与调姿大部件的可对合性后,保持目标大部件上架后位姿固定不动,而调姿大部件随调姿对合设备运动。将测量设备架设在固定位置,测量设备选用激光跟踪仪。通过测量设备控制模块204控制激光跟踪仪实时跟随调姿特征点。The posture adjustment and matching equipment determines the support position of the target large component and the posture adjustment large component on the shelf according to the center of gravity of the large component, the support position and the posture adjustment and matching stroke, and then controls the posture adjustment and matching equipment to move to the support position on the shelf through the posture adjustment and matching equipment control module 206, and then hoists the target large component and the posture adjustment large component to the corresponding posture adjustment and matching equipment respectively. After ensuring the matchability of the target large component and the posture adjustment large component, the posture of the target large component after being mounted on the shelf is kept fixed, and the posture adjustment large component moves with the posture adjustment and matching equipment. The measuring equipment is set up in a fixed position, and the measuring equipment uses a laser tracker. The laser tracker is controlled by the measuring equipment control module 204 to follow the posture adjustment feature points in real time.
步骤2、基于调姿大部件平移过程中测量的调姿特征点的实时位置,拟合平移轴线;基于调姿大部件旋转过程中测量的调姿特征点的实时位置,拟合旋转中心;基于平移轴线与旋转中心建立调姿对合坐标系;Step 2: Fit the translation axis based on the real-time position of the posture feature points measured during the translation of the posture large component; fit the rotation center based on the real-time position of the posture feature points measured during the rotation of the posture large component; establish a posture alignment coordinate system based on the translation axis and the rotation center;
具体为:Specifically:
调姿对合设备带动调姿大部件做平移以及旋转方向的精确运动,通过激光跟踪仪跟随调姿大部件上任意一调姿特征点运动并测量其在运动过程中的位置信息。The posture adjustment and alignment equipment drives the posture adjustment large component to perform precise movement in translation and rotation. The laser tracker follows the movement of any posture adjustment feature point on the posture adjustment large component and measures its position information during the movement.
一套调姿对合设备由若干个数控定位器组成,且一套调姿对合设备带动调姿大部件做笛卡尔坐标系下的X、Y、Z三个方向上的平移以及绕A轴、B轴、C轴三个旋转方向旋转;A set of posture adjustment and alignment equipment is composed of several CNC positioners, and a set of posture adjustment and alignment equipment drives the posture adjustment large parts to translate in the three directions of X, Y, and Z in the Cartesian coordinate system and rotate around the three directions of A, B, and C axes;
通过运动后置解算模块202内置的程序,控制各数控定位器的运动轴按照运算的轨迹规划路径带动调姿大部件进行运动,保证调姿大部件运动过程中不产生对调姿大部件进行拉扯、挤压的外力。Through the built-in program of the motion post-solving module 202, the motion axes of each CNC positioner are controlled to drive the posture adjustment large component to move according to the calculated trajectory planning path, ensuring that no external force that pulls or squeezes the posture adjustment large component is generated during the movement of the posture adjustment large component.
调姿大部件伴随调姿对合设备在两个Y、Z两个方向进行平移,激光跟踪仪在跟踪仪坐标系TCS下跟随测量调姿大部件上的调姿特征点沿Y向平移,以及沿Z向平移过程中的多个位置信息如下:The posture adjustment large component is translated in two directions, Y and Z, along with the posture adjustment alignment equipment. The laser tracker follows and measures the posture adjustment feature points on the posture adjustment large component in the tracker coordinate system TCS and translates along the Y direction. The multiple position information during the translation along the Z direction is as follows:
调姿特征点在Y向平移的位置信息:,其中/>表示调姿特征点沿Y向平移的1至m个位置信息,具体为位置坐标。Position information of the posture adjustment feature point in the Y direction: , where/> Indicates the position information of 1 to m positions of the posture adjustment feature points translated along the Y direction, specifically the position coordinates.
调姿特征点在Z向平移的位置信息:,其中/>表示调姿特征点沿Z向平移的1至m个位置信息,具体为位置坐标。Position information of the posture adjustment feature point in the Z direction: , where/> It represents the position information of 1 to m positions of the posture adjustment feature points translated along the Z direction, specifically the position coordinates.
调姿大部件伴随调姿对合设备在任意旋转坐标方向分别旋转,激光跟踪仪在跟踪仪坐标系TCS下跟随测量任意旋转方向多个调姿特征点的位置信息。如调姿大部件伴随调姿对合设备绕A轴旋转得到调姿特征点绕A轴旋转的位置信息为,其中/>表示调姿特征点沿A向旋转的1至m个位置信息,具体为位置坐标。The large posture adjustment component rotates along with the posture adjustment device in any rotation coordinate direction, and the laser tracker follows and measures the position information of multiple posture adjustment feature points in any rotation direction in the tracker coordinate system TCS. For example, if the large posture adjustment component rotates along with the posture adjustment device around the A axis, the position information of the posture adjustment feature points rotating around the A axis is: , where/> Represents the position information of 1 to m positions of the posture adjustment feature point rotated along the A direction, specifically the position coordinates.
调姿对合坐标系创建模块203基于 、 分别拟合Y平移轴与Z平移轴,具体为:The posture adjustment coordinate system creation module 203 is based on , Fit the Y translation axis and the Z translation axis respectively, specifically:
通过调姿对合坐标系创建模块203内置的程序,根据、,将其代人直线方程式(1):Through the program built into the pose adjustment coordinate system creation module 203, according to , , and substitute it into the linear equation (1):
式(1) Formula 1)
其中:x表示位置信息中的x坐标,y表示位置信息中的y坐标,z表示位置信息中的z坐标,表示直线方程参数。Where: x represents the x coordinate in the location information, y represents the y coordinate in the location information, z represents the z coordinate in the location information, Represents the parameters of the line equation.
将式(1)转换为矩阵形式的式(2):Convert equation (1) into the matrix form of equation (2):
式(2) Formula (2)
其中:x i 表示位置信息中的i组x坐标,y i 表示位置信息中的i组y坐标,z i 表示位置信息中的i组z坐标,T表示矩阵的转置运算。Wherein: xi represents the i -group x- coordinate in the position information, yi represents the i - group y -coordinate in the position information, zi represents the i -group z -coordinate in the position information, and T represents the transpose operation of the matrix.
将式(2)化简为式(3):Simplify formula (2) into formula (3):
式(3) Formula (3)
基于式(3),令,并利用多元线性回归最小二乘法估计模型式(4):Based on formula (3), let , and use the multivariate linear regression least squares method to estimate the model (4):
式(4) Formula (4)
以及求最优解矩阵算法式(5):And the optimal solution matrix algorithm (5):
式(5) Formula (5)
其中:表示关于/>的最优解矩阵。in: Indicates about/> The optimal solution matrix.
求解出最佳的直线方程参数,将直线方程参数/>带入式(1)从而得到Y平移轴与Z平移轴的直线组式方程。Solve for the best straight line equation parameters , and the parameters of the straight line equation/> Substituting into equation (1), we can obtain the linear equations of the Y translation axis and the Z translation axis.
令式(1)中的z分别为任意常量z0与常量zi,根据式(1)分别求得常量、常量/>、常量x i 、常量y i ,利用直线上两点坐标求解直线L单位方向矢量(L x ,L y ,L z ):Let z in equation (1) be any constant z 0 and constant z i , and calculate the constants according to equation (1): , constants/> , constants x i , constants y i , and use the coordinates of two points on the line to solve the unit direction vector of line L (L x , Ly , L z ):
式(6)Formula (6)
其中:L x 表示直线L在X向的单位方向矢量;L y 表示直线L在Y向的单位方向矢量;L z 表示直线L在Z向的单位方向矢量。Wherein: Lx represents the unit direction vector of the straight line L in the X direction; Ly represents the unit direction vector of the straight line L in the Y direction; Lz represents the unit direction vector of the straight line L in the Z direction.
从而得到直线的Y向矢量为(Y x ,Y y ,Y z ,)、直线三维Z向矢量为(Z x ,Z y ,Z z ),对直线三维Y向矢量与直线三维Z向矢量进行式(7)的叉积运算:Thus, the Y vector of the straight line is (Y x , Y y , Y z ), and the three-dimensional Z vector of the straight line is (Z x , Z y , Z z ). The cross product operation of the three-dimensional Y vector and the three-dimensional Z vector of the straight line is performed as follows:
式(7) Formula (7)
其中:表示直线的Y向矢量与直线的Z向矢量的叉积运算;i、j、k为直角坐标系单位方向向量,i、j、k前面的系数即为X向矢量V x 分量值;V x 表示直线的X向矢量。in: Represents the cross product operation of the Y-vector of the straight line and the Z-vector of the straight line; i, j, k are the unit direction vectors of the rectangular coordinate system, and the coefficients in front of i, j, k are the component values of the X-vector Vx ; Vx represents the X-vector of the straight line.
调姿对合坐标系创建模块203基于拟合旋转中心,具体为:The posture adjustment coordinate system creation module 203 is based on Fit the rotation center, specifically:
调姿对合坐标系创建模块203根据,建立球面方程:The posture adjustment coordinate system creation module 203 is based on , establish the spherical equation:
式(8) Formula (8)
其中:表示球面方程的第i个x坐标变量,/>表示球面方程的第i个y坐标变量;/>表示球面方程的第i个z坐标变量,/>表示球心坐标;r表示球面半径。in: represents the ith x- coordinate variable of the spherical equation,/> Represents the i -th y- coordinate variable of the spherical equation;/> represents the i -th z- coordinate variable of the spherical equation,/> represents the coordinates of the center of the sphere; r represents the radius of the sphere.
根据式(8)建立距离平方的平差方程并进行泰勒展开得到:According to formula (8), the distance square adjustment equation is established and Taylor expansion is performed to obtain:
式(9)Formula (9)
式(9)符合多元线性回归最小二乘法估计模型式(4),利用求最优解矩阵算法式(5),求解出旋转中心的坐标为。Formula (9) is consistent with the multivariate linear regression least squares estimation model (4). Using the optimal solution matrix algorithm (5), the coordinates of the rotation center are solved as .
通过调姿对合坐标系创建模块203将直线Y矢量作为调姿对合坐标系的Y向,将直线Z向矢量/>作为调姿对合坐标系的Z向,将求得的X向矢量/>作为调姿对合坐标系的X向,将拟合计算的旋转中心作为原点,继而得出调姿对合坐标系。The Y vector of the straight line is converted into As the Y direction of the posture adjustment coordinate system, the Z direction vector of the straight line is As the Z direction of the posture adjustment coordinate system, the obtained X direction vector As the X direction of the pose adjustment coordinate system, the rotation center of the fitting calculation is As the origin, the posture adjustment coordinate system is obtained .
步骤3、在调姿对合坐标系下,在目标大部件与调姿大部件上建立对合特征位置,基于目标大部件上的对合特征位置与调姿大部件上的对合特征位置之间的形状误差参数进行迭代位姿拟合,求解调姿大部件相对于目标大部件移动对合的平移参数、旋转参数、尺度缩放参数。Step 3. In the pose adjustment coordinate system, establish alignment feature positions on the target large component and the pose adjustment large component, perform iterative pose fitting based on the shape error parameters between the alignment feature positions on the target large component and the alignment feature positions on the pose adjustment large component, and solve the translation parameters, rotation parameters, and scale scaling parameters of the pose adjustment large component relative to the target large component.
具体为:Specifically:
以调姿大部件作为调姿对合的主动调整对象,以目标大部件作为调姿对合的被动目标对象;将激光跟踪仪坐标系变换到调姿对合坐标系下,在调姿对合坐标系下进行所有对合特征位置的测量。The large posture adjustment component is used as the active adjustment object of the posture adjustment, and the target large component is used as the passive target object of the posture adjustment; the laser tracker coordinate system is transformed into the posture adjustment coordinate system, and the positions of all the alignment features are measured in the posture adjustment coordinate system.
通过测量设备控制模块204,将激光跟踪仪的坐标系TCS变换到调姿对合坐标系WCS,使得激光跟踪仪的坐标系TCS测量的数据变换为调姿对合坐标系WCS下的数据/>。The laser tracker coordinate system TCS is transformed into the attitude adjustment coordinate system WCS by the measurement device control module 204, so that the data measured by the laser tracker coordinate system TCS Transformed into data under the posture adjustment coordinate system WCS/> .
即:Right now:
式(10) Formula (10)
式(11) Formula (11)
其中:R表示调姿对合坐标系WCS相对于坐标系TCS的旋转参数,且;t表示调姿对合坐标系WCS相对于坐标系TCS的平移参数,且;/>表示在激光跟踪仪的坐标系中第i个对合特征位置的x坐标;表示在激光跟踪仪的坐标系中第i个对合特征位置的y坐标;/>表示在激光跟踪仪的坐标系中第i个对合特征位置的z坐标;Vx表示直线X矢量;Vy表示直线Y矢量;Vz表示直线Z矢量;/>分别表示调姿对合坐标系WCS的原点在坐标系TCS下的三轴坐标。Where: R represents the rotation parameter of the pose adjustment coordinate system WCS relative to the coordinate system TCS, and ; t represents the translation parameter of the pose adjustment coordinate system WCS relative to the coordinate system TCS, and ; /> represents the x- coordinate of the position of the i -th involute feature in the coordinate system of the laser tracker; represents the y coordinate of the position of the i -th involute feature in the coordinate system of the laser tracker;/> represents the z coordinate of the i -th involute feature position in the coordinate system of the laser tracker; V x represents the straight line X vector; V y represents the straight line Y vector; V z represents the straight line Z vector; /> They respectively represent the three-axis coordinates of the origin of the pose adjustment coordinate system WCS in the coordinate system TCS.
在大部件调姿对合坐标系下,基于目标位置与当前位置进行位姿优化拟合变换运算,控制调姿设备按变换平移、旋转参数进行调姿对合运动,包括:In the large-component posture adjustment coordinate system, the posture optimization fitting transformation operation is performed based on the target position and the current position, and the posture adjustment device is controlled to perform posture adjustment movement according to the transformation translation and rotation parameters, including:
基于目标大部件上的特征对合位置与调姿大部件上的特征对合位置,进行目标大部件与调姿大部件之间的形状误差参数的拟合,得出理想调姿误差的边界;Based on the feature matching position on the target large component and the feature matching position on the posture adjustment large component, the shape error parameters between the target large component and the posture adjustment large component are fitted to obtain the boundary of the ideal posture adjustment error;
若理想调姿误差边界都在工艺允差范围之内,则位姿优化拟合变换运算求满足所有工艺允差的可行解;若理想调姿误差边界超出其工艺允差范围,则位姿优化拟合变换运算通过迭代求出全局最优解,上述位姿优化拟合变换运算的结果为平移参数t和旋转参数R。If the ideal posture adjustment error boundaries are within the process tolerance range, the posture optimization fitting transformation operation is performed to find a feasible solution that meets all process tolerances; if the ideal posture adjustment error boundaries exceed its process tolerance range, the posture optimization fitting transformation operation is performed through iteration to find the global optimal solution. The results of the above posture optimization fitting transformation operation are the translation parameter t and the rotation parameter R.
调姿对合设备带动调姿大部件在调姿对合坐标系下,按照平移参数t和旋转参数R进行运动,运动至与目标大部件上的特征对合位置完成对合的位置,即完成调姿大部件与目标大部件的对合。The posture adjustment and alignment equipment drives the posture adjustment large component to move in the posture adjustment and alignment coordinate system according to the translation parameter t and the rotation parameter R, and moves to the position where the alignment is completed with the characteristic alignment position on the target large component, thereby completing the alignment of the posture adjustment large component with the target large component.
具体的,位姿优化拟合变换运算是通过位姿拟合变换运算模块205,基于目标大部件上第i个基准钉点的位置与调姿大部件上第i个基准钉点的位置,利用加权的ICP迭代运算求得/>与之间的变换参数,变换参数包括平移参数t、旋转参数R、尺度缩放参数s。Specifically, the pose optimization fitting transformation operation is performed by the pose fitting transformation operation module 205 based on the position of the i-th reference pin point on the target large component. The position of the i-th reference pin point on the posture adjustment large component , using weighted ICP iteration to obtain/> and The transformation parameters between them include translation parameter t , rotation parameter R , and scale parameter s .
具体为:Specifically:
1、建立与/>之间的变换参数矩阵如下:1. Establishment With/> The transformation parameter matrix between is as follows:
式(12) Formula (12)
令;;make ; ;
则有:Then we have:
式(13) Formula (13)
其中:R表示旋转参数;t表示平移参数;表示目标大部件上第i个基准钉点/>的三轴坐标;/>表示调姿大部件上第i个基准钉点/>的三轴坐标。Where: R represents the rotation parameter; t represents the translation parameter; Indicates the i -th reference pin point on the target large component/> The three-axis coordinates of; /> Indicates the i -th reference pin point on the posture adjustment large component/> The three-axis coordinates of .
2、建立最小二乘法残差模型如下:2. The least squares residual model is established as follows:
式(14) Formula (14)
其中:表示第i个基准钉点的基准残差;in: represents the benchmark residual of the i -th benchmark nail point;
令;/>;/>;make ; /> ; /> ;
则有:Then we have:
式(15) Formula (15)
式(16) Formula (16)
其中:表示对/>的转置运算。in: Expressing support for/> The transpose operation of .
根据式(16)则有:According to formula (16), we have:
式(17) Formula (17)
其中:表示最优解。/> in: Indicates the optimal solution. />
通过式(14)至式(17)迭代解算旋转参数R与平移参数t,利用迭代后的旋转参数R与平移参数t迭代解算基准钉点的基准残差。The rotation parameter R and the translation parameter t are iteratively solved by equations (14) to (17), and the reference residual of the reference pin point is iteratively solved by using the iterative rotation parameter R and translation parameter t .
根据基准残差解算各个基准钉点的权重:Based on the benchmark residual Calculate the weight of each benchmark pin point:
式(18) Formula (18)
其中:表示第i个基准钉点的权重;/>表示第i个基准钉点的基准残差;n表示基准钉点的数量。in: Represents the weight of the i -th reference nail point;/> represents the benchmark residual of the i -th benchmark nail point; n represents the number of benchmark nail points.
根据各个基准钉点的权重进一步求解基准钉点的加权中心化值:The weighted centralization value of the benchmark pin point is further solved according to the weight of each benchmark pin point:
式(19) Formula (19)
;/>(20) ; /> (20)
其中:表示目标大部件上所有基准钉点的加权中心化值;/>表示调姿大部件上所有基准钉点的加权中心化值;/>表示目标大部件上第i个基准钉点的中心化值;/>表示调姿大部件上第i个基准钉点的中心化值;/>表示目标大部件上第i个基准钉点的去中心化值;/>表示调姿大部件上第i个基准钉点的去中心化值。in: Represents the weighted centralization value of all reference pin points on the target large component; /> Represents the weighted centralization value of all reference pins on the posture adjustment large component; /> Indicates the centralization value of the i-th reference pin point on the target large component; /> Indicates the centralization value of the i-th reference pin point on the posture adjustment large component; /> Indicates the decentralized value of the i-th reference pin point on the target large component; /> Represents the decentralized value of the i-th reference pin point on the large pose adjustment component.
根据各个基准钉点的加权中心化值建立SVD调姿模型:The SVD posture adjustment model is established according to the weighted central value of each benchmark pin point:
式(21) Formula (21)
其中:H表示SVD运算待分解的矩阵;U、V是矩阵H的特征向量;S是矩阵H的特征值;VT是矩阵V的转置。Among them: H represents the matrix to be decomposed by SVD operation; U and V are the eigenvectors of matrix H; S is the eigenvalue of matrix H; VT is the transpose of matrix V.
基于式(20)、式(21),利用、/>先求解出H,再对H进行奇异值分解(即SVD运算)运算,得出特征向量U和V,将V和UT进行点积运算得到位姿拟合变换的旋转参数/>,利用进而求得位姿拟合变换平移参数/>:/> Based on formula (20) and formula (21), using 、/> First solve H, then perform singular value decomposition (SVD) on H to obtain the eigenvectors U and V, and perform dot product operation on V and UT to obtain the rotation parameters of the pose fitting transformation/> ,use Then obtain the translation parameters of the pose fitting transformation/> :/>
式(22) Formula (22)
其中:表示加权后的旋转参数;/>表示加权后的平移参数。in: Represents the weighted rotation parameters; /> Represents the weighted translation parameter.
将加权后的旋转参数与加权后的平移参数作为ICP迭代运算新的初始值,重复上述迭代步骤,直到对合特征位置的方差收敛,导出优化的平移参数、旋转参数。The weighted rotation parameters and the weighted translation parameters are used as new initial values for the ICP iterative operation, and the above iterative steps are repeated until the variance of the involute feature position converges, and the optimized translation parameters and rotation parameters are derived.
基于优化的平移参数、旋转参数,建立尺度缩放参数的平差模型:Based on the optimized translation parameters and rotation parameters, the adjustment model of scale parameters is established:
式(23) Formula (23)
其中:表示第i个基准钉点基于尺度缩放参数的基准残差;s表示尺度缩放参数;/>表示优化后的旋转参数;/>表示优化后的平移参数。in: represents the benchmark residual of the i -th benchmark pin point based on the scale scaling parameter; s represents the scale scaling parameter; /> Represents the optimized rotation parameters; /> Represents the optimized translation parameters.
令;/>,则利用最小二乘法求解优化的尺度缩放参数如下:make ; /> , then the optimized scaling parameters are solved by the least squares method as follows:
基于可得:based on Available:
;式(24) ; Formula (24)
其中:表示优化的尺度缩放参数。in: Represents the optimized scaling parameter.
步骤4、根据步骤3中得到的平移参数、旋转参数、尺度缩放参数控制调姿对合设备带动调姿大部件相对于目标大部件进行移动对合。Step 4: According to the translation parameters, rotation parameters, and scale parameters obtained in step 3, the posture adjustment and alignment equipment is controlled to drive the posture adjustment large component to move and align relative to the target large component.
具体为:Specifically:
调姿对合设备控制模块206根据解算出的旋转参数、平移参数、尺度缩放参数输入控制调姿对合设备,同时运动后置解算模块202解算各个数控定位器的运动轴的几何数据,调姿对合设备控制模块206基于运动轴的几何数据,结合旋转参数、平移参数、尺度缩放参数带动调姿大部件进行相应的平移和旋转运动,直到调姿大部件与目标大部件对合。The attitude adjustment and alignment device control module 206 controls the attitude adjustment and alignment device according to the calculated rotation parameters, translation parameters, and scale scaling parameter inputs. At the same time, the motion post-calculation module 202 calculates the geometric data of the motion axes of each CNC positioner. The attitude adjustment and alignment device control module 206 drives the attitude adjustment large component to perform corresponding translation and rotation movements based on the geometric data of the motion axes in combination with the rotation parameters, translation parameters, and scale scaling parameters until the attitude adjustment large component is aligned with the target large component.
调姿大部件运动到位后,采用激光跟踪仪再次测量调姿特征点的位置,当采用位姿拟合运算的可行解进行调姿对合运动时,直接将调姿大部件运动到位后的测量数据与目标数据进行对比,评判调姿对合是否合格,若不合格则基于当前位置再次进行位姿拟合运算并调姿对合,直到调姿对合合格为止。当采用位姿拟合运算的全局最优解进行调姿对合运动时,将运动到位后的调姿大部件的测量数据加入尺度缩放系数,通过式(23)运算测量数据与目标数据进行对比,评判调姿对合是否合格,若不合格则基于当前位置再次进行位姿拟合运算并调姿对合,直到调姿对合合格为止。After the large posture adjustment component moves into place, the position of the posture adjustment feature point is measured again by a laser tracker. When the feasible solution of the posture fitting operation is used for the posture adjustment alignment movement, the measured data of the large posture adjustment component after it moves into place is directly compared with the target data to judge whether the posture adjustment alignment is qualified. If it is unqualified, the posture fitting operation is performed again based on the current position and the posture adjustment alignment is performed until the posture adjustment alignment is qualified. When the global optimal solution of the posture fitting operation is used for the posture adjustment alignment movement, the measured data of the large posture adjustment component after it moves into place is added with the scale scaling coefficient, and the measured data is compared with the target data through the operation of formula (23) to judge whether the posture adjustment alignment is qualified. If it is unqualified, the posture fitting operation is performed again based on the current position and the posture adjustment alignment is performed until the posture adjustment alignment is qualified.
本实施例的其他部分与实施例1-3任一项相同,故不再赘述。The other parts of this embodiment are the same as any one of Embodiments 1-3, so they are not described again.
以上,仅是本发明的较佳实施例,并非对本发明做任何形式上的限制,凡依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化,均落入本发明的保护范围之内。The above are only preferred embodiments of the present invention and are not intended to limit the present invention in any form. Any simple modifications or equivalent changes made to the above embodiments based on the technical essence of the present invention fall within the protection scope of the present invention.
Claims (9)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202410677004.7A CN118239003B (en) | 2024-05-29 | 2024-05-29 | Component posture adjustment and alignment method without fixed measuring field, storage medium and control system |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202410677004.7A CN118239003B (en) | 2024-05-29 | 2024-05-29 | Component posture adjustment and alignment method without fixed measuring field, storage medium and control system |
Publications (2)
Publication Number | Publication Date |
---|---|
CN118239003A true CN118239003A (en) | 2024-06-25 |
CN118239003B CN118239003B (en) | 2024-09-10 |
Family
ID=91556981
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202410677004.7A Active CN118239003B (en) | 2024-05-29 | 2024-05-29 | Component posture adjustment and alignment method without fixed measuring field, storage medium and control system |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN118239003B (en) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101695814A (en) * | 2009-10-15 | 2010-04-21 | 浙江大学 | Method and device for precisely positioning large part of airplane in place |
US20190005185A1 (en) * | 2017-06-30 | 2019-01-03 | Aerion Corporation | Computing Techniques for Three-Dimensional Modeling and Design Analysis |
CN109871664A (en) * | 2019-01-08 | 2019-06-11 | 南京航空航天大学 | A transfer station accuracy optimization method for aircraft assembly large-scale multi-station measurement field |
CN115391882A (en) * | 2022-08-09 | 2022-11-25 | 中信建筑设计研究总院有限公司 | Construction method of multivariate data fusion holographic space system |
-
2024
- 2024-05-29 CN CN202410677004.7A patent/CN118239003B/en active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101695814A (en) * | 2009-10-15 | 2010-04-21 | 浙江大学 | Method and device for precisely positioning large part of airplane in place |
US20190005185A1 (en) * | 2017-06-30 | 2019-01-03 | Aerion Corporation | Computing Techniques for Three-Dimensional Modeling and Design Analysis |
CN109871664A (en) * | 2019-01-08 | 2019-06-11 | 南京航空航天大学 | A transfer station accuracy optimization method for aircraft assembly large-scale multi-station measurement field |
CN115391882A (en) * | 2022-08-09 | 2022-11-25 | 中信建筑设计研究总院有限公司 | Construction method of multivariate data fusion holographic space system |
Non-Patent Citations (1)
Title |
---|
李志强等: "基于SIMOTION D455 的大部件调姿对合系统研制", 制造技术与机床, no. 7, 2 July 2021 (2021-07-02), pages 129 - 132 * |
Also Published As
Publication number | Publication date |
---|---|
CN118239003B (en) | 2024-09-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109877840B (en) | Double-mechanical-arm calibration method based on camera optical axis constraint | |
CN106705956B (en) | Industrial robot end pose rapid measuring device and measuring method thereof | |
CN107421442B (en) | An Online Compensation Method for Robot Positioning Error Aided by External Measurement | |
CN111203861B (en) | Calibration method and calibration system for robot tool coordinate system | |
CN112975973B (en) | A hybrid calibration method and device applied to a flexible robot | |
CN112959325A (en) | High-precision control method for collaborative machining of double-moving mechanical arm in large scene | |
CN113510709B (en) | Industrial robot pose precision online compensation method based on deep reinforcement learning | |
CN113146600B (en) | Flexible robot trajectory planning method and device based on kinematics iterative learning control | |
CN114147726B (en) | Robot calibration method combining geometric error with non-geometric error | |
CN113580148B (en) | Kinematics Calibration Method for Parallel Robot Based on Equivalent Kinematic Chain | |
CN110666793A (en) | Method for realizing robot square part assembly based on deep reinforcement learning | |
MX2014003540A (en) | Calibration and programming of robots. | |
CN108908347B (en) | Fault-tolerant repetitive motion planning method for redundant mobile mechanical arm | |
CN112536797A (en) | Comprehensive compensation method for position and attitude errors of industrial robot | |
CN109093376B (en) | Multi-axis hole automatic alignment method based on laser tracker | |
Wang et al. | Pose accuracy compensation of mobile industry robot with binocular vision measurement and deep belief network | |
CN105773622A (en) | Industrial robot absolute accuracy calibrating method based on IEKF | |
CN115229796A (en) | A robot end pose tracking compensation method for the milling of large aerospace components | |
CN113561183B (en) | An online tracking method and system for robotic arm target points based on pose tracking system | |
CN114161425A (en) | Error compensation method of industrial robot | |
JPH0445841B2 (en) | ||
Yang et al. | Optimal configuration for mobile robotic grinding of large complex components based on redundant parameters | |
CN118239003B (en) | Component posture adjustment and alignment method without fixed measuring field, storage medium and control system | |
CN114505865B (en) | Pose tracking-based mechanical arm path generation method and system | |
JPH0445842B2 (en) |
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 |