[go: up one dir, main page]

CN118456333B - Vertical thin cabin docking device and posture adjustment docking method based on three-phase machine measurement - Google Patents

Vertical thin cabin docking device and posture adjustment docking method based on three-phase machine measurement Download PDF

Info

Publication number
CN118456333B
CN118456333B CN202410931331.0A CN202410931331A CN118456333B CN 118456333 B CN118456333 B CN 118456333B CN 202410931331 A CN202410931331 A CN 202410931331A CN 118456333 B CN118456333 B CN 118456333B
Authority
CN
China
Prior art keywords
cabin
movable
axis
compartment
equation
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
CN202410931331.0A
Other languages
Chinese (zh)
Other versions
CN118456333A (en
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.)
Chengdu Zhiyuan Advanced Manufacturing Technology Research Institute Co ltd
Original Assignee
Chengdu Zhiyuan Advanced Manufacturing Technology Research Institute Co ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Chengdu Zhiyuan Advanced Manufacturing Technology Research Institute Co ltd filed Critical Chengdu Zhiyuan Advanced Manufacturing Technology Research Institute Co ltd
Priority to CN202410931331.0A priority Critical patent/CN118456333B/en
Publication of CN118456333A publication Critical patent/CN118456333A/en
Application granted granted Critical
Publication of CN118456333B publication Critical patent/CN118456333B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25BTOOLS OR BENCH DEVICES NOT OTHERWISE PROVIDED FOR, FOR FASTENING, CONNECTING, DISENGAGING OR HOLDING
    • B25B11/00Work holders not covered by any preceding group in the subclass, e.g. magnetic work holders, vacuum work holders
    • B25B11/02Assembly jigs
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B23MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
    • B23PMETAL-WORKING NOT OTHERWISE PROVIDED FOR; COMBINED OPERATIONS; UNIVERSAL MACHINE TOOLS
    • B23P19/00Machines for simply fitting together or separating metal parts or objects, or metal and non-metal parts, whether or not involving some deformation; Tools or devices therefor so far as not provided for in other classes
    • B23P19/10Aligning parts to be fitted together

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Length Measuring Devices By Optical Means (AREA)

Abstract

本发明涉及快速对接技术领域,提供了一种基于三相机测量的立式薄舱对接装置及调姿对接方法。该装置包括机械调姿模块和视觉测量模块;机械调姿模块包括:调姿工装环;水平调节机构;竖直对合机构;视觉测量块包括:电动伸缩悬架;两个第一轴线对正靶标;两个第二轴线对正靶标;第孔销对齐靶标;第二孔销对齐靶标。该方法包括:S1、得到轴线空间方程;S2、得到角度偏差方程;S3、规划出活动舱段的调姿路径;S4、活动舱段与固定舱段共线;S5、活动舱段上的销孔与固定舱段上的销轴对齐;S6、活动舱段对接到固定舱段上。本发明一方面得到轴线空间方程;另一方面得到角度偏差方程。然后规划出活动舱段的调姿路径,实现高精度高效率快速对接。

The present invention relates to the technical field of rapid docking, and provides a vertical thin cabin docking device and an attitude adjustment docking method based on three-camera measurement. The device includes a mechanical attitude adjustment module and a visual measurement module; the mechanical attitude adjustment module includes: an attitude adjustment tooling ring; a horizontal adjustment mechanism; a vertical alignment mechanism; the visual measurement block includes: an electric telescopic suspension; two first axis alignment targets; two second axis alignment targets; the first hole pin alignment target; the second hole pin alignment target. The method includes: S1, obtaining the axis space equation; S2, obtaining the angle deviation equation; S3, planning the attitude adjustment path of the movable cabin; S4, the movable cabin and the fixed cabin are in line; S5, the pin hole on the movable cabin is aligned with the pin shaft on the fixed cabin; S6, the movable cabin is docked to the fixed cabin. The present invention obtains the axis space equation on the one hand; and obtains the angle deviation equation on the other hand. Then the attitude adjustment path of the movable cabin is planned to achieve high-precision and high-efficiency rapid docking.

Description

一种基于三相机测量的立式薄舱对接装置及调姿对接方法A vertical thin cabin docking device and attitude adjustment docking method based on three-camera measurement

技术领域Technical Field

本发明涉及快速对接技术领域,具体涉及一种基于三相机测量的立式薄舱对接装置及调姿对接方法。The present invention relates to the technical field of rapid docking, and in particular to a vertical thin cabin docking device and a posture adjustment docking method based on three-camera measurement.

背景技术Background Art

随着航天事业的迅猛发展,航天器及船舶等大型薄壁舱段的高精度高效率装配对接是当下亟需突破的难题。为了解决这一问题,大量的舱段类部件调姿机构和基于对接特征的位姿检测方法应运而生,满足了一部分舱段对接装配的需求。With the rapid development of the aerospace industry, high-precision and high-efficiency assembly and docking of large thin-walled cabins such as spacecraft and ships is a difficult problem that needs to be solved urgently. In order to solve this problem, a large number of cabin component attitude adjustment mechanisms and attitude detection methods based on docking features have emerged to meet the needs of some cabin docking and assembly.

然而,考虑到舱段内部复杂的部件结构和特殊场景装配需求,立式舱段对接在大型舱段对接装配领域的分量不断增加。相比于传统的卧式舱段对接,立式舱段对接的难度大,效率低,不仅需要考虑舱段自重所带来的薄壁舱段变形,还需进一步考虑在对接特征位姿测量上的遮挡情况。因此,传统的机械调姿模块和位姿检测模块很难适用,其次,常见的对接策略也很难在现有的对接设备上奏效。However, considering the complex component structure inside the cabin and the assembly requirements in special scenarios, vertical cabin docking is becoming increasingly important in the field of large cabin docking and assembly. Compared with traditional horizontal cabin docking, vertical cabin docking is difficult and inefficient. It not only needs to consider the deformation of thin-walled cabins caused by the cabin's own weight, but also needs to further consider the occlusion in the measurement of docking characteristic posture. Therefore, traditional mechanical posture adjustment modules and posture detection modules are difficult to apply. Secondly, common docking strategies are also difficult to work on existing docking equipment.

因此,设计一种用于立式薄舱的对接装置和位姿在线检测方法很有必要,以实现立式薄舱的高精度高效率快速对接。Therefore, it is necessary to design a docking device and an online posture detection method for vertical thin cabins to achieve high-precision, high-efficiency and rapid docking of vertical thin cabins.

发明内容Summary of the invention

针对现有技术中的缺陷,本发明的目的是提供一种基于三相机测量的立式薄舱对接装置及调姿对接方法,以实现立式薄舱的高精度高效率快速对接。In view of the defects in the prior art, the purpose of the present invention is to provide a vertical thin cabin docking device and an attitude adjustment docking method based on three-camera measurement, so as to achieve high-precision, high-efficiency and rapid docking of vertical thin cabins.

根据本发明的第一个方面,提供一种基于三相机测量的立式薄舱对接装置,用于实现活动舱段与固定舱段的对接,包括控制系统和固定架,还包括机械调姿模块和视觉测量模块;According to a first aspect of the present invention, there is provided a vertical thin cabin docking device based on three-camera measurement, which is used to achieve docking of a movable cabin section with a fixed cabin section, comprising a control system and a fixing frame, and also comprising a mechanical attitude adjustment module and a visual measurement module;

所述机械调姿模块包括:The mechanical posture adjustment module comprises:

调姿工装环,所述调姿工装环沿横向设置在所述固定架的内部,所述调姿工装环与所述活动舱段相适应,所述调姿工装环与所述控制系统电连接、用于控制所述活动舱段自转;An attitude adjustment tooling ring, which is laterally arranged inside the fixing frame, adapted to the movable compartment, and electrically connected to the control system for controlling the rotation of the movable compartment;

水平调节机构,所述水平调节机构与所述控制系统电连接、用于控制所述调姿工装环在水平面上移动;A horizontal adjustment mechanism, which is electrically connected to the control system and is used to control the posture adjustment tooling ring to move on a horizontal plane;

竖直对合机构,所述竖直对合机构与所述控制系统电连接、用于控制所述水平调节机构沿竖直方向移动;A vertical alignment mechanism, the vertical alignment mechanism is electrically connected to the control system and is used to control the horizontal adjustment mechanism to move in a vertical direction;

所述视觉测量模块包括:The visual measurement module includes:

电动伸缩悬架,所述电动伸缩悬架沿纵向设置、且与所述控制系统电连接,所述电动伸缩悬架的第一端与所述固定架固定连接,所述电动伸缩悬架的第二端安装有两台轴线对正靶标测量相机和一台孔销对齐靶标测量相机;An electric telescopic suspension, the electric telescopic suspension is arranged in the longitudinal direction and is electrically connected to the control system, a first end of the electric telescopic suspension is fixedly connected to the fixing frame, and a second end of the electric telescopic suspension is equipped with two axis alignment target measurement cameras and one hole pin alignment target measurement camera;

两个第一轴线对正靶标,两个所述第一轴线对正靶标均安装在所述固定舱段上,所述第一轴线对正靶标上具有三个不共线的第一标记点;Two first axis alignment targets, both of which are mounted on the fixed compartment, and the first axis alignment targets have three non-collinear first marking points;

两个第二轴线对正靶标,两个所述第二轴线对正靶标均安装在所述活动舱段上,所述第二轴线对正靶标上具有三个不共线的第二标记点;Two second axis alignment targets, both of which are mounted on the movable compartment, and the second axis alignment targets have three non-collinear second marking points;

第一孔销对齐靶标,所述第一孔销对齐靶标安装在所述固定舱段上,所述第一孔销对齐靶标上具有第三标记点;a first hole pin alignment target, wherein the first hole pin alignment target is mounted on the fixed compartment section, and the first hole pin alignment target has a third marking point;

第二孔销对齐靶标,所述第二孔销对齐靶标安装在所述活动舱段上,所述第二孔销对齐靶标上具有第四标记点。A second hole pin alignment target is installed on the movable compartment section, and a fourth marking point is provided on the second hole pin alignment target.

进一步地,所述调姿工装环的内侧面上固定安装有承重垫环。Furthermore, a load-bearing pad ring is fixedly installed on the inner side surface of the posture adjustment tooling ring.

进一步地,所述调姿工装环的数量为两个,两个所述调姿工装环分别位于所述活动舱段的上部和下部。Furthermore, there are two posture adjustment tooling rings, and the two posture adjustment tooling rings are respectively located at the upper part and the lower part of the movable compartment section.

进一步地,所述水平调节机构具有四个,四个所述水平调节机构分别位于两个所述调姿工装环的两侧。Furthermore, there are four horizontal adjustment mechanisms, which are respectively located on both sides of the two posture adjustment tooling rings.

根据本发明的第二个方面,提供一种调姿对接方法,包括以下步骤:According to a second aspect of the present invention, a posture adjustment docking method is provided, comprising the following steps:

S1、分别解析计算得到所述固定舱段的轴线空间方程和所述活动舱段的轴线空间方程;S1. Analytically calculating and obtaining the axis space equation of the fixed compartment and the axis space equation of the movable compartment respectively;

S2、解析计算得到所述活动舱段上的销孔与所述固定舱段上的销轴之间的角度偏差方程;S2. Analytically calculate and obtain an angle deviation equation between the pin hole on the movable compartment and the pin shaft on the fixed compartment;

S3、所述控制系统规划出所述活动舱段从初始位姿到目标位姿的调姿路径,所述目标位姿为所述活动舱段的轴心与所述固定舱段的轴线共线、并且所述活动舱段上的销孔与所述固定舱段上的销轴对齐;S3, the control system plans a posture adjustment path of the movable cabin from an initial posture to a target posture, wherein the target posture is that the axis of the movable cabin is collinear with the axis of the fixed cabin, and the pin hole on the movable cabin is aligned with the pin shaft on the fixed cabin;

S4、所述控制系统控制所述水平调节机构启动,使得所述活动舱段的轴心与所述固定舱段的轴线共线;S4, the control system controls the horizontal adjustment mechanism to start, so that the axis of the movable compartment is in line with the axis of the fixed compartment;

S5、所述控制系统控制所述调姿工装环启动,使得所述活动舱段上的销孔与所述固定舱段上的销轴对齐;S5, the control system controls the posture adjustment tooling ring to start, so that the pin hole on the movable compartment is aligned with the pin shaft on the fixed compartment;

S6、所述控制系统控制所述竖直对合机构启动,将所述活动舱段对接到所述固定舱段上。S6. The control system controls the vertical docking mechanism to start and dock the movable compartment to the fixed compartment.

进一步地,所述步骤S1包括:Furthermore, the step S1 comprises:

S7、分别提取两个所述第一轴线对正靶标上的三个所述第一标记点的坐标数据;S7, respectively extracting coordinate data of the three first marking points on the two first axis alignment targets;

S8、将S7中的六个所述坐标数据转换到同一个基准空间坐标系上;S8, converting the six coordinate data in S7 to the same reference space coordinate system;

S9、在步骤S8中选定三个坐标数据形成第一基准面,所述第一基准面与所述固定舱段的轴线存在交线,计算得到第一基准面的平面方程;S9, selecting three coordinate data in step S8 to form a first reference plane, where the first reference plane and the axis of the fixed compartment have an intersection line, and calculating the plane equation of the first reference plane;

S10、在步骤S8中选定三个坐标数据形成第二基准面,所述第二基准面与所述固定舱段的轴线存在交线,计算得到第二基准面的平面方程;S10, selecting the three coordinate data in step S8 to form a second reference plane, where the second reference plane has an intersection line with the axis of the fixed compartment, and calculating the plane equation of the second reference plane;

S11、联立第一基准面的平面方程和第二基准面的平面方程得到固定舱段的轴线空间方程。S11. Combining the plane equation of the first reference plane and the plane equation of the second reference plane, the axial space equation of the fixed compartment is obtained.

进一步地,所述步骤S1包括:Furthermore, the step S1 comprises:

S12、分别提取两个所述第二轴线对正靶标上的三个所述第二标记点的坐标数据;S12, respectively extracting coordinate data of three second marking points on two targets aligned with the second axes;

S13、将S12中的六个坐标数据转换到同一个基准空间坐标系上;S13, converting the six coordinate data in S12 to the same reference space coordinate system;

S14、在步骤S13中选定三个坐标数据形成第三基准面,所述第三基准面与所述活动舱段的轴线存在交线,计算得到第三基准面的平面方程;S14, selecting three coordinate data in step S13 to form a third reference plane, wherein the third reference plane has an intersection line with the axis of the movable compartment, and calculating a plane equation of the third reference plane;

S15、在步骤S13中选定三个坐标数据形成第四基准面,所述第四基准面与所述活动舱段的轴线存在交线,计算得到第四基准面的平面方程;S15, selecting three coordinate data in step S13 to form a fourth reference plane, wherein the fourth reference plane has an intersection line with the axis of the movable compartment, and calculating a plane equation of the fourth reference plane;

S16、联立第三基准面的平面方程和第四基准面的平面方程得到活动舱段的轴线空间方程。S16. Combining the plane equation of the third reference plane and the plane equation of the fourth reference plane, the axial space equation of the movable compartment is obtained.

进一步地,所述步骤S2包括:Furthermore, the step S2 comprises:

S17、分别提取第一孔销对齐靶标上的第三标记点的坐标数据和第二孔销对齐靶标上的第四标记点的坐标数据;S17, respectively extracting the coordinate data of the third marking point on the first hole pin alignment target and the coordinate data of the fourth marking point on the second hole pin alignment target;

S18、将S17中的两个坐标数据转换到同一基准水平坐标系上;S18, converting the two coordinate data in S17 to the same reference horizontal coordinate system;

S19、解析得到角度偏差方程。S19. Analyze and obtain the angle deviation equation.

有益效果:本发明提供的一种基于三相机测量的立式薄舱对接装置及其设计方法,在视觉测量模块的作用下,控制系统一方面分别解析计算得到固定舱段的轴线空间方程和活动舱段的轴线空间方程;另一方面解析计算得到活动舱段上的销孔与固定舱段上的销轴之间的角度偏差方程。然后控制系统规划出活动舱段从初始位姿到目标位姿的调姿路径,并通过机械调姿模块将活动舱段对接到固定舱段上,以实现立式薄舱的高精度高效率快速对接。Beneficial effect: The present invention provides a vertical thin cabin docking device based on three-camera measurement and its design method. Under the action of the visual measurement module, the control system analyzes and calculates the axis space equation of the fixed cabin section and the axis space equation of the movable cabin section respectively on the one hand; on the other hand, the angle deviation equation between the pin hole on the movable cabin section and the pin shaft on the fixed cabin section is analyzed and calculated. Then the control system plans the attitude adjustment path of the movable cabin section from the initial posture to the target posture, and docks the movable cabin section to the fixed cabin section through the mechanical attitude adjustment module to achieve high-precision, high-efficiency and rapid docking of the vertical thin cabin.

附图说明BRIEF DESCRIPTION OF THE DRAWINGS

图1为本装置的立体结构示意图;FIG1 is a schematic diagram of the three-dimensional structure of the device;

图2为本装置的侧视结构示意图;FIG2 is a schematic diagram of the side structure of the device;

图3为本装置的正视结构示意图;FIG3 is a schematic diagram of the front structure of the device;

图4为轴线对正靶标测量相机和孔销对齐靶标测量相机的结构示意图;FIG4 is a schematic diagram of the structure of an axis-aligned target measurement camera and a hole-pin-aligned target measurement camera;

图5为轴线空间方程的解析计算示意图;FIG5 is a schematic diagram of analytical calculation of the axis space equation;

图6为角度偏差方程的解析计算示意图;FIG6 is a schematic diagram of analytical calculation of the angle deviation equation;

图7为本发明工作时的流程结构框图。FIG. 7 is a flow chart showing the structure of the present invention when it is working.

附图标记:10-活动舱段、20-固定舱段、30-固定架、40-机械调姿模块、41-调姿工装环、411-承重垫环、42-水平调节机构、43-竖直对合机构、50-视觉测量模块、51-电动伸缩悬架、52-第一轴线对正靶标、53-第二轴线对正靶标、54-第一孔销对齐靶标、55-第二孔销对齐靶标、56-轴线对正靶标测量相机、57-孔销对齐靶标测量相机。Figure numerals: 10-movable cabin section, 20-fixed cabin section, 30-fixed frame, 40-mechanical attitude adjustment module, 41-attitude adjustment tooling ring, 411-load-bearing pad ring, 42-horizontal adjustment mechanism, 43-vertical alignment mechanism, 50-visual measurement module, 51-electric telescopic suspension, 52-first axis alignment target, 53-second axis alignment target, 54-first hole pin alignment target, 55-second hole pin alignment target, 56-axis alignment target measurement camera, 57-hole pin alignment target measurement camera.

具体实施方式DETAILED DESCRIPTION

为使本发明实现的技术手段、创作特征、达成目的与功效易于明白了解,下面结合具体实施方式,进一步阐述本发明。In order to make the technical means, creative features, objectives and effects achieved by the present invention easy to understand, the present invention is further explained below in conjunction with specific implementation methods.

在本发明中,除非另有明确的规定和限定,术语“连接”、“固定”应做广义理解,例如,可以是固定连接,也可以是可拆卸连接,或成一体;可以是机械连接,也可以是电连接;可以是直接相连,也可以通过中间媒介间接相连,可以是两个元件内部的连通或两个元件的相互作用关系。对于本领域的普通技术人员而言,可以根据具体情况理解上述术语在本发明中的具体含义。In the present invention, unless otherwise clearly specified and limited, the terms "connection" and "fixation" should be understood in a broad sense, for example, it can be a fixed connection, a detachable connection, or an integral 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 the internal connection of two elements or the 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 specific circumstances.

在本发明的描述中,需要理解的是,术语“纵”、“横”、“水平”、“顶”、“底”、“上”、“下”、“内”和“外”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。In the description of the present invention, it is necessary to understand that the terms "longitudinal", "lateral", "horizontal", "top", "bottom", "up", "down", "inside" and "outside" etc. indicating orientations or positional relationships are based on the orientations or positional relationships shown in the accompanying drawings, and are only for the convenience of describing the present invention and simplifying the description, rather than indicating or implying that the device or element referred to must have a specific orientation, be constructed and operated in a specific orientation, and therefore should not be understood as a limitation on the present invention.

此外,术语“第一”、“第二”等仅用于描述目的,而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。在本发明的描述中,“多个”的含义是两个以上,除非另有明确具体的限定。In addition, the terms "first", "second", etc. are used for descriptive purposes only and should not be understood as indicating or implying relative importance or implicitly indicating the number of technical features indicated. In the description of the present invention, the meaning of "plurality" is more than two, unless otherwise clearly and specifically defined.

如图1-图4所示,本发明提供一种基于三相机测量的立式薄舱对接装置,用于实现活动舱段10与固定舱段20的对接,包括控制系统和固定架30,还包括机械调姿模块40和视觉测量模块50。As shown in Figures 1 to 4, the present invention provides a vertical thin cabin docking device based on three-camera measurement, which is used to achieve docking of a movable cabin section 10 with a fixed cabin section 20, including a control system and a fixed frame 30, and also includes a mechanical attitude adjustment module 40 and a visual measurement module 50.

机械调姿模块40包括调姿工装环41、水平调节机构42和竖直对合机构43。The mechanical posture adjustment module 40 includes a posture adjustment tooling ring 41 , a horizontal adjustment mechanism 42 and a vertical alignment mechanism 43 .

调姿工装环41沿横向设置在固定架30的内部,调姿工装环41与活动舱段10相适应,调姿工装环41与控制系统电连接、用于控制活动舱段10自转。优选地,调姿工装环41的结构可以包括一个固定环和一个活动环,两者同轴设置。活动舱段10放置在活动环上,固定环与固定架30固定连接,固定环上固定安装有电机,电机可以通过带轮或齿轮齿环结构带动转动环旋转,从而控制活动舱段10自转。调姿工装环41的具体结构不限定,只要能够控制活动舱段10自转即可。优选地,调姿工装环41的大小可根据活动舱段10的型号做不同程度的调整,内侧设计了20mm厚度的聚氨酯材料板,与活动舱段10夹持可靠,保证了调姿精度。The posture adjustment tooling ring 41 is arranged laterally inside the fixed frame 30, and the posture adjustment tooling ring 41 is adapted to the movable cabin section 10. The posture adjustment tooling ring 41 is electrically connected to the control system and is used to control the rotation of the movable cabin section 10. Preferably, the structure of the posture adjustment tooling ring 41 may include a fixed ring and a movable ring, which are coaxially arranged. The movable cabin section 10 is placed on the movable ring, and the fixed ring is fixedly connected to the fixed frame 30. A motor is fixedly installed on the fixed ring, and the motor can drive the rotating ring to rotate through a pulley or a gear ring structure, thereby controlling the rotation of the movable cabin section 10. The specific structure of the posture adjustment tooling ring 41 is not limited, as long as it can control the rotation of the movable cabin section 10. Preferably, the size of the posture adjustment tooling ring 41 can be adjusted to different degrees according to the model of the movable cabin section 10, and a 20mm thick polyurethane material plate is designed on the inner side, which is reliably clamped with the movable cabin section 10 to ensure the posture adjustment accuracy.

水平调节机构42与控制系统电连接、用于控制调姿工装环41在水平面上移动。水平调节机构42能够控制调姿工装环41在X轴和Y轴方向上移动。优选地,水平调节机构42可以包括侧滑组件和电动伸缩杆,侧滑组件为丝杠滚珠结构,电动伸缩杆沿横向设置,电动伸缩杆的两端分别与滚珠和调姿工装环41固定连接。当侧滑组件启动时,调姿工装环41就会在Y轴方向上移动;当电动伸缩杆启动时,调姿工装环41就会在X轴方向上移动。水平调节机构42的具体结构不限定,只要能够控制调姿工装环41在水平面上移动即可。The horizontal adjustment mechanism 42 is electrically connected to the control system and is used to control the posture adjustment tooling ring 41 to move in the horizontal plane. The horizontal adjustment mechanism 42 can control the posture adjustment tooling ring 41 to move in the X-axis and Y-axis directions. Preferably, the horizontal adjustment mechanism 42 may include a side sliding component and an electric telescopic rod, the side sliding component is a screw ball structure, the electric telescopic rod is arranged in the horizontal direction, and the two ends of the electric telescopic rod are respectively fixedly connected to the ball and the posture adjustment tooling ring 41. When the side sliding component is started, the posture adjustment tooling ring 41 will move in the Y-axis direction; when the electric telescopic rod is started, the posture adjustment tooling ring 41 will move in the X-axis direction. The specific structure of the horizontal adjustment mechanism 42 is not limited, as long as it can control the posture adjustment tooling ring 41 to move in the horizontal plane.

竖直对合机构43,竖直对合机构43与控制系统电连接、用于控制水平调节机构42沿竖直方向移动。竖直对合机构43为现有技术,具体结构在此不再赘述。The vertical alignment mechanism 43 is electrically connected to the control system and is used to control the horizontal adjustment mechanism 42 to move in the vertical direction. The vertical alignment mechanism 43 is a prior art, and the specific structure is not described in detail here.

视觉测量模块50包括电动伸缩悬架51、两个第一轴线对正靶标52、两个第二轴线对正靶标53、第一孔销对齐靶标54和第二孔销对齐靶标55。The vision measurement module 50 includes an electric telescopic suspension 51 , two first axis alignment targets 52 , two second axis alignment targets 53 , a first hole pin alignment target 54 and a second hole pin alignment target 55 .

电动伸缩悬架51沿纵向设置、且与控制系统电连接,电动伸缩悬架51的第一端与固定架30固定连接,电动伸缩悬架51的第二端安装有两台轴线对正靶标测量相机56和一台孔销对齐靶标测量相机57。优选地,电动伸缩悬架51具有横向和纵向伸缩功能,适用于各种型号的活动舱段10和固定舱段20的位姿测量,在安装时其中心与固定舱段20端面中心在一条竖直线上。The electric telescopic suspension 51 is arranged longitudinally and electrically connected to the control system. The first end of the electric telescopic suspension 51 is fixedly connected to the fixed frame 30. The second end of the electric telescopic suspension 51 is installed with two axis alignment target measurement cameras 56 and one hole pin alignment target measurement camera 57. Preferably, the electric telescopic suspension 51 has transverse and longitudinal telescopic functions, and is suitable for posture measurement of various types of movable cabins 10 and fixed cabins 20. When installed, its center is on a vertical line with the center of the end face of the fixed cabin 20.

两个第一轴线对正靶标52均镜像对称地安装在固定舱段20上,第一轴线对正靶标52上具有三个不共线的第一标记点。The two first axis alignment targets 52 are both mounted on the fixed compartment 20 in a mirror-symmetrical manner, and the first axis alignment target 52 has three non-collinear first marking points.

两个第二轴线对正靶标53均镜像对称地安装在活动舱段10上,第二轴线对正靶标53上具有三个不共线的第二标记点。The two second axis alignment targets 53 are both mounted on the movable compartment 10 in a mirror-symmetrical manner, and the second axis alignment target 53 has three non-collinear second marking points.

第一孔销对齐靶标54安装在固定舱段20上,第一孔销对齐靶标54上具有第三标记点。The first hole pin alignment target 54 is installed on the fixed compartment section 20 , and the first hole pin alignment target 54 has a third marking point.

第二孔销对齐靶标55安装在活动舱段10上,第二孔销对齐靶标55上具有第四标记点。The second hole pin alignment target 55 is installed on the movable compartment 10 , and the second hole pin alignment target 55 has a fourth marking point.

初始状态下,固定舱段20放置在固定架30上的底部,活动舱段10放置在调姿工装环41上,活动舱段10位于固定舱段20的上方。In the initial state, the fixed cabin section 20 is placed at the bottom of the fixed frame 30 , the movable cabin section 10 is placed on the posture adjustment tooling ring 41 , and the movable cabin section 10 is located above the fixed cabin section 20 .

在一个实施例中,调姿工装环41的内侧面上固定安装有承重垫环411。承重垫环411采用特殊抗压材质而制,不仅保证调姿的平滑性,而且在活动舱段10和调姿工装环41之间起到过度作用,避免了活动舱段10因自重而变形。In one embodiment, a load-bearing pad ring 411 is fixedly mounted on the inner side of the posture adjustment tool ring 41. The load-bearing pad ring 411 is made of a special pressure-resistant material, which not only ensures the smoothness of the posture adjustment, but also plays a transition role between the movable cabin 10 and the posture adjustment tool ring 41, thereby preventing the movable cabin 10 from being deformed due to its own weight.

在一个实施例中,调姿工装环41的数量为两个,两个调姿工装环41分别位于活动舱段10的上部和下部。两个调姿工装环41分别在上部和下部对活动舱段10形成支撑,使其稳定性更好。In one embodiment, there are two posture adjustment tooling rings 41, and the two posture adjustment tooling rings 41 are respectively located at the upper part and the lower part of the movable compartment 10. The two posture adjustment tooling rings 41 respectively support the movable compartment 10 at the upper part and the lower part to make it more stable.

在一个实施例中,水平调节机构42具有四个,四个水平调节机构42分别位于两个调姿工装环41的两侧。四个水平调节机构42同步启动和关闭,从而使得活动舱段10的移动更加稳定。In one embodiment, there are four horizontal adjustment mechanisms 42, and the four horizontal adjustment mechanisms 42 are respectively located on both sides of the two posture adjustment tooling rings 41. The four horizontal adjustment mechanisms 42 are started and closed synchronously, so that the movement of the movable compartment 10 is more stable.

根据本发明的第二个方面,如图5-图7所示,提供一种调姿对接方法,包括以下步骤:According to a second aspect of the present invention, as shown in FIGS. 5 to 7 , a posture adjustment docking method is provided, comprising the following steps:

S1、控制系统分别解析计算得到固定舱段20的轴线空间方程和活动舱段10的轴线空间方程。S1. The control system analytically calculates the axis space equation of the fixed compartment 20 and the axis space equation of the movable compartment 10 respectively.

S2、控制系统解析计算得到活动舱段10上的销孔与固定舱段20上的销轴之间的角度偏差方程。S2. The control system obtains an angular deviation equation between the pin hole on the movable compartment 10 and the pin shaft on the fixed compartment 20 through analytical calculation.

S3、控制系统根据固定舱段20的轴线空间方程、活动舱段10的轴线空间方程和活动舱段10上的销孔与固定舱段20上的销轴之间的角度偏差方程,规划出活动舱段10从初始位姿到目标位姿的调姿路径。S3. The control system plans the attitude adjustment path of the movable cabin 10 from the initial position to the target position according to the axis space equation of the fixed cabin 20, the axis space equation of the movable cabin 10 and the angle deviation equation between the pin hole on the movable cabin 10 and the pin shaft on the fixed cabin 20.

具体地,目标位姿为活动舱段10的轴心与固定舱段20的轴线共线、并且活动舱段10上的销孔与固定舱段20上的销轴对齐。Specifically, the target posture is that the axis of the movable section 10 is collinear with the axis of the fixed section 20 , and the pin hole on the movable section 10 is aligned with the pin axis on the fixed section 20 .

控制系统将调姿路径信号传输给水平调节机构42和调姿工装环41。The control system transmits the attitude adjustment path signal to the horizontal adjustment mechanism 42 and the attitude adjustment tooling ring 41 .

S4、水平调节机构42接收到控制系统的调姿路径信号后启动,控制调姿工装环41和活动舱段10在X轴和Y轴上移动,直到活动舱段10的轴心与固定舱段20的轴线共线。S4. The horizontal adjustment mechanism 42 is started after receiving the attitude adjustment path signal of the control system, and controls the attitude adjustment tooling ring 41 and the movable cabin section 10 to move on the X-axis and Y-axis until the axis of the movable cabin section 10 is collinear with the axis of the fixed cabin section 20.

S5、调姿工装环41接收到控制系统的调姿路径信号后启动,控制活动舱段10自转,直到活动舱段10上的销孔与固定舱段20上的销轴对齐。S5. The attitude adjustment tooling ring 41 starts after receiving the attitude adjustment path signal from the control system, and controls the movable cabin section 10 to rotate until the pin hole on the movable cabin section 10 is aligned with the pin shaft on the fixed cabin section 20.

S6、拆下所有的第一轴线对正靶标52、第二轴线对正靶标53、第一孔销对齐靶标54和第二孔销对齐靶标55。控制系统控制竖直对合机构43启动,由于此时活动舱段10的轴心与固定舱段20的轴线已经共线,活动舱段10上的销孔与固定舱段20上的销轴已经对齐,因此竖直对合机构43控制活动舱段10向下移动,活动舱段10就会准确对接到固定舱段20上。S6. Remove all the first axis alignment targets 52, second axis alignment targets 53, first hole pin alignment targets 54 and second hole pin alignment targets 55. The control system controls the vertical alignment mechanism 43 to start. Since the axis of the movable compartment 10 and the axis of the fixed compartment 20 are already in line, the pin hole on the movable compartment 10 and the pin shaft on the fixed compartment 20 are already aligned, the vertical alignment mechanism 43 controls the movable compartment 10 to move downward, and the movable compartment 10 will be accurately docked with the fixed compartment 20.

在一个实施例中,步骤S1包括:In one embodiment, step S1 includes:

S7、控制系统控制电动伸缩悬架51伸长,两台轴线对正靶标测量相机56分别提取两个第一轴线对正靶标52上的三个第一标记点的坐标数据。其中第一台轴线对正靶标测量相机56的测量坐标系为,令其为基准空间坐标系,其测量的点为,, 。第二台轴线对正靶标测量相机56的测量坐标系为,其测量的点为, , S7, the control system controls the electric telescopic suspension 51 to extend, and the two axis alignment target measurement cameras 56 respectively extract the coordinate data of the three first marking points on the two first axis alignment targets 52. The measurement coordinate system of the first axis alignment target measurement camera 56 is , let it be the reference space coordinate system, and the measured point is , , The measurement coordinate system of the second axis-aligned target measurement camera 56 is , the measurement point is , , .

S8、令两台轴线对正靶标测量相机56的测量坐标系之间的转换矩阵为(R,t),将D、E、F点的坐标数据转换到基准空间坐标系上。S8. Let the conversion matrix between the measurement coordinate systems of the two axis-aligned target measurement cameras 56 be (R, t), and convert the coordinate data of points D, E, and F into the reference space coordinate system.

S9、在步骤S8中选定A、B、F三点形成第一基准面,第一基准面与固定舱段20的轴线存在交线,计算得到第一基准面的平面方程。S9. In step S8, three points A, B and F are selected to form a first reference plane. The first reference plane intersects the axis of the fixed compartment 20, and the plane equation of the first reference plane is calculated.

具体地,设通过A、B、F三点的平面方程的一般式方程为,将点数值代入方程,即得,化简得:Specifically, let the general equation of the plane equation passing through points A, B, and F be ,Will Substitute the point value into the equation , that is , simplified to:

再根据, , 三点坐标分别求得M、N、Q的值,如下:According to , , The values of M, N, and Q are obtained by the coordinates of the three points, as follows:

又因为,所以可以求得的值,将求得的M、N、Q、值代入一般式方程就可得过三点的第一基准面的平面方程: (一般式)。Also because , so we can get The value of M, N, Q, Substituting the values into the general equation yields , , Plane equation of the first datum plane of three points: (General form).

S10、在步骤S8中选定C、D、E三点形成第二基准面,第二基准面与固定舱段20的轴线存在交线,计算得到第二基准面的平面方程。S10. In step S8, three points C, D and E are selected to form a second reference plane. The second reference plane intersects the axis of the fixed compartment 20, and the plane equation of the second reference plane is calculated.

具体地,同理可得由三点行程的第二基准面的平面方程: (一般式)。 Specifically, the same logic can be obtained from , , Plane equation of the second reference plane of the three-point travel: (General formula).

S11、联立第一基准面的平面方程和第二基准面的平面方程即可得到固定舱段20的轴线空间方程。S11. The axis space equation of the fixed compartment 20 can be obtained by combining the plane equation of the first reference plane and the plane equation of the second reference plane.

两式联立,可求得固定舱段20的轴线空间方程为:By combining the two equations, the axial space equation of the fixed compartment 20 can be obtained as follows:

在一个实施例中,步骤S1包括:In one embodiment, step S1 includes:

S12、分别提取两个第二轴线对正靶标53上的三个第二标记点的坐标数据;S12, respectively extracting coordinate data of three second marking points on the two second axis alignment targets 53;

S13、将S12中的六个坐标数据转换到同一个基准空间坐标系上;S13, converting the six coordinate data in S12 to the same reference space coordinate system;

S14、在步骤S13中选定三个坐标数据形成第三基准面,第三基准面与活动舱段10的轴线存在交线,计算得到第三基准面的平面方程;S14, in step S13, three coordinate data are selected to form a third reference plane, the third reference plane has an intersection line with the axis of the movable compartment 10, and the plane equation of the third reference plane is calculated;

S15、在步骤S13中选定三个坐标数据形成第四基准面,第四基准面与活动舱段10的轴线存在交线,计算得到第四基准面的平面方程;S15, in step S13, three coordinate data are selected to form a fourth reference plane, the fourth reference plane has an intersection line with the axis of the movable compartment 10, and the plane equation of the fourth reference plane is calculated;

S16、联立第三基准面的平面方程和第四基准面的平面方程得到活动舱段10的轴线空间方程;S16, combining the plane equation of the third reference plane and the plane equation of the fourth reference plane to obtain the axis space equation of the movable compartment 10;

在一个实施例中,步骤S2包括:In one embodiment, step S2 includes:

S17、一台孔销对齐靶标测量相机57分别先后提取第一孔销对齐靶标54上的第三标记点的坐标数据和第二孔销对齐靶标55上的第四标记点的坐标数据。S17, a hole pin alignment target measurement camera 57 successively extracts the coordinate data of the third mark point on the first hole pin alignment target 54 and the coordinate data of the fourth mark point on the second hole pin alignment target 55.

S18、将S17中的两个坐标数据转换到同一基准水平坐标系上。S18, converting the two coordinate data in S17 to the same reference horizontal coordinate system.

S19、前后两次测量位姿产生角度偏差,即偏差角可由其中一对孔销对齐靶标的竖直偏差与分度圆半径R近似得到解析得到角度偏差方程:S19, the angle deviation between the two measured postures, that is, the deviation angle The vertical deviation of the target can be aligned by one pair of pins The angle deviation equation is obtained by approximating the pitch circle radius R:

以上显示和描述了本发明的基本原理和主要特征和本发明的优点,对于本领域技术人员而言,显然本发明不限于上述示范性实施例的细节,而且在不背离本发明的精神或基本特征的情况下,能够以其他的具体形式实现本发明。因此,无论从哪一点来看,均应将实施例看作是示范性的,而且是非限制性的,本发明的范围由所附权利要求而不是上述说明限定,因此旨在将落在权利要求的等同要件的含义和范围内的所有变化囊括在本发明内。The above shows and describes the basic principles and main features of the present invention and the advantages of the present invention. It is obvious to those skilled in the art that the present invention is not limited to the details of the above exemplary embodiments, and the present invention can be implemented in other specific forms without departing from the spirit or basic features of the present invention. Therefore, no matter from which point of view, the embodiments should be regarded as exemplary and non-restrictive. The scope of the present invention is defined by the appended claims rather than the above description, and it is intended that all changes falling within the meaning and scope of the equivalent elements of the claims are included in the present invention.

此外,应当理解,虽然本说明书按照实施方式加以描述,但并非每个实施方式仅包含一个独立的技术方案,说明书的这种叙述方式仅仅是为清楚起见,本领域技术人员应当将说明书作为一个整体,各实施例中的技术方案也可以经适当组合,形成本领域技术人员可以理解的其他实施方式。In addition, it should be understood that although the present specification is described according to implementation modes, not every implementation mode contains only one independent technical solution. This narrative method of the specification is only for the sake of clarity. Those skilled in the art should regard the specification as a whole. The technical solutions in each embodiment can also be appropriately combined to form other implementation modes that can be understood by those skilled in the art.

Claims (8)

1.一种基于三相机测量的立式薄舱对接装置,用于实现活动舱段与固定舱段的对接,包括控制系统和固定架,其特征在于:还包括机械调姿模块和视觉测量模块;1. A vertical thin cabin docking device based on three-camera measurement, used to achieve docking between a movable cabin section and a fixed cabin section, including a control system and a fixing frame, characterized in that: it also includes a mechanical attitude adjustment module and a visual measurement module; 所述机械调姿模块包括:The mechanical posture adjustment module comprises: 调姿工装环,所述调姿工装环沿横向设置在所述固定架的内部,所述调姿工装环与所述活动舱段相适应,所述调姿工装环包括一个固定环和一个活动环,所述固定环与所述活动环同轴设置,所述调姿工装环与所述控制系统电连接、用于控制所述活动舱段自转;An attitude adjustment tooling ring, which is laterally arranged inside the fixing frame, adapted to the movable compartment, and includes a fixed ring and a movable ring, wherein the fixed ring and the movable ring are coaxially arranged, and the attitude adjustment tooling ring is electrically connected to the control system and is used to control the rotation of the movable compartment; 水平调节机构,所述水平调节机构包括侧滑组件和电动伸缩杆,所述侧滑组件为丝杠滚珠结构,所述电动伸缩杆沿横向设置,所述电动伸缩杆的两端分别与滚珠和所述调姿工装环固定连接,所述水平调节机构与所述控制系统电连接、用于控制所述调姿工装环在水平面上移动;A horizontal adjustment mechanism, the horizontal adjustment mechanism comprising a side sliding assembly and an electric telescopic rod, the side sliding assembly is a lead screw ball structure, the electric telescopic rod is arranged in the transverse direction, the two ends of the electric telescopic rod are respectively fixedly connected to the ball and the posture adjustment tooling ring, the horizontal adjustment mechanism is electrically connected to the control system, and is used to control the posture adjustment tooling ring to move on the horizontal plane; 竖直对合机构,所述竖直对合机构与所述控制系统电连接、用于控制所述水平调节机构沿竖直方向移动;A vertical alignment mechanism, the vertical alignment mechanism is electrically connected to the control system and is used to control the horizontal adjustment mechanism to move in a vertical direction; 所述视觉测量模块包括:The visual measurement module includes: 电动伸缩悬架,所述电动伸缩悬架沿纵向设置、且与所述控制系统电连接,所述伸缩悬架的第一端与所述固定架固定连接,所述伸缩悬架的第二端安装有两台轴线对正靶标测量相机和一台孔销对齐靶标测量相机;An electric telescopic suspension, the electric telescopic suspension is arranged in the longitudinal direction and is electrically connected to the control system, a first end of the telescopic suspension is fixedly connected to the fixing frame, and a second end of the telescopic suspension is equipped with two axis alignment target measurement cameras and one hole pin alignment target measurement camera; 两个第一轴线对正靶标,两个所述第一轴线对正靶标均安装在所述固定舱段上,所述第一轴线对正靶标上具有三个不共线的第一标记点;Two first axis alignment targets, both of which are mounted on the fixed compartment, and the first axis alignment targets have three non-collinear first marking points; 两个第二轴线对正靶标,两个所述第二轴线对正靶标均安装在所述活动舱段上,所述第二轴线对正靶标上具有三个不共线的第二标记点;Two second axis alignment targets, both of which are mounted on the movable compartment, and the second axis alignment targets have three non-collinear second marking points; 第一孔销对齐靶标,所述第一孔销对齐靶标安装在所述固定舱段上,所述第一孔销对齐靶标上具有第三标记点;a first hole pin alignment target, wherein the first hole pin alignment target is mounted on the fixed compartment section, and the first hole pin alignment target has a third marking point; 第二孔销对齐靶标,所述第二孔销对齐靶标安装在所述活动舱段上,所述第二孔销对齐靶标上具有第四标记点。A second hole pin alignment target is installed on the movable compartment section, and a fourth marking point is provided on the second hole pin alignment target. 2.根据权利要求1所述的一种基于三相机测量的立式薄舱对接装置,其特征在于:所述调姿工装环的内侧面上固定安装有承重垫环。2. A vertical thin cabin docking device based on three-camera measurement according to claim 1, characterized in that a load-bearing pad ring is fixedly installed on the inner side of the posture adjustment tooling ring. 3.根据权利要求2所述的一种基于三相机测量的立式薄舱对接装置,其特征在于:所述调姿工装环的数量为两个,两个所述调姿工装环分别位于所述活动舱段的上部和下部。3. According to a vertical thin cabin docking device based on three-camera measurement as described in claim 2, it is characterized in that the number of the posture adjustment tooling rings is two, and the two posture adjustment tooling rings are respectively located at the upper and lower parts of the movable cabin section. 4.根据权利要求3所述的一种基于三相机测量的立式薄舱对接装置,其特征在于:所述水平调节机构具有四个,四个所述水平调节机构分别位于两个所述调姿工装环的两侧。4. A vertical thin cabin docking device based on three-camera measurement according to claim 3, characterized in that: there are four horizontal adjustment mechanisms, and the four horizontal adjustment mechanisms are respectively located on both sides of the two posture adjustment tooling rings. 5.一种调姿对接方法,应用于权利要求4所述的基于三相机测量的立式薄舱对接装置,其特征在于:包括以下步骤:5. A posture adjustment docking method, applied to the vertical thin cabin docking device based on three-camera measurement according to claim 4, characterized in that it comprises the following steps: S1、分别解析计算得到所述固定舱段的轴线空间方程和所述活动舱段的轴线空间方程;S1. Analytically calculating and obtaining the axis space equation of the fixed compartment and the axis space equation of the movable compartment respectively; S2、解析计算得到所述活动舱段上的销孔与所述固定舱段上的销轴之间的角度偏差方程;S2. Analytically calculate and obtain an angle deviation equation between the pin hole on the movable compartment and the pin shaft on the fixed compartment; S3、所述控制系统规划出所述活动舱段从初始位姿到目标位姿的调姿路径,所述目标位姿为所述活动舱段的轴心与所述固定舱段的轴线共线、并且所述活动舱段上的销孔与所述固定舱段上的销轴对齐;S3, the control system plans a posture adjustment path of the movable cabin from an initial posture to a target posture, wherein the target posture is that the axis of the movable cabin is collinear with the axis of the fixed cabin, and the pin hole on the movable cabin is aligned with the pin shaft on the fixed cabin; S4、所述控制系统控制所述水平调节机构启动,使得所述活动舱段的轴心与所述固定舱段的轴线共线;S4, the control system controls the horizontal adjustment mechanism to start, so that the axis of the movable compartment is in line with the axis of the fixed compartment; S5、所述控制系统控制所述调姿工装环启动,使得所述活动舱段上的销孔与所述固定舱段上的销轴对齐;S5, the control system controls the posture adjustment tooling ring to start, so that the pin hole on the movable compartment is aligned with the pin shaft on the fixed compartment; S6、所述控制系统控制所述竖直对合机构启动,将所述活动舱段对接到所述固定舱段上。S6. The control system controls the vertical docking mechanism to start and dock the movable compartment to the fixed compartment. 6.根据权利要求5所述的一种调姿对接方法,其特征在于:6. A posture adjustment docking method according to claim 5, characterized in that: 所述步骤S1包括:The step S1 comprises: S7、分别提取两个所述第一轴线对正靶标上的三个所述第一标记点的坐标数据;S7, respectively extracting coordinate data of the three first marking points on the two first axis alignment targets; S8、将S7中的六个所述坐标数据转换到同一个基准空间坐标系上;S8, converting the six coordinate data in S7 to the same reference space coordinate system; S9、在步骤S8中选定三个坐标数据形成第一基准面,所述第一基准面与所述固定舱段的轴线存在交线,计算得到第一基准面的平面方程;S9, selecting three coordinate data in step S8 to form a first reference plane, where the first reference plane and the axis of the fixed compartment have an intersection line, and calculating the plane equation of the first reference plane; S10、在步骤S8中选定三个坐标数据形成第二基准面,所述第二基准面与所述固定舱段的轴线存在交线,计算得到第二基准面的平面方程;S10, selecting the three coordinate data in step S8 to form a second reference plane, where the second reference plane has an intersection line with the axis of the fixed compartment, and calculating the plane equation of the second reference plane; S11、联立第一基准面的平面方程和第二基准面的平面方程得到固定舱段的轴线空间方程。S11. Combining the plane equation of the first reference plane and the plane equation of the second reference plane, the axial space equation of the fixed compartment is obtained. 7.根据权利要求5所述的一种调姿对接方法,其特征在于:7. A posture adjustment docking method according to claim 5, characterized in that: 所述步骤S1包括:The step S1 comprises: S12、分别提取两个所述第二轴线对正靶标上的三个所述第二标记点的坐标数据;S12, respectively extracting coordinate data of three second marking points on two targets aligned with the second axes; S13、将S12中的六个坐标数据转换到同一个基准空间坐标系上;S13, converting the six coordinate data in S12 to the same reference space coordinate system; S14、在步骤S13中选定三个坐标数据形成第三基准面,所述第三基准面与所述活动舱段的轴线存在交线,计算得到第三基准面的平面方程;S14, selecting three coordinate data in step S13 to form a third reference plane, wherein the third reference plane has an intersection line with the axis of the movable compartment, and calculating a plane equation of the third reference plane; S15、在步骤S13中选定三个坐标数据形成第四基准面,所述第四基准面与所述活动舱段的轴线存在交线,计算得到第四基准面的平面方程;S15, selecting three coordinate data in step S13 to form a fourth reference plane, wherein the fourth reference plane has an intersection line with the axis of the movable compartment, and calculating a plane equation of the fourth reference plane; S16、联立第三基准面的平面方程和第四基准面的平面方程得到活动舱段的轴线空间方程。S16. Combining the plane equation of the third reference plane and the plane equation of the fourth reference plane, the axial space equation of the movable compartment is obtained. 8.根据权利要求5所述的一种调姿对接方法,其特征在于:8. A posture adjustment docking method according to claim 5, characterized in that: 所述步骤S2包括:The step S2 comprises: S17、分别提取第一孔销对齐靶标上的第三标记点的坐标数据和第二孔销对齐靶标上的第四标记点的坐标数据;S17, respectively extracting the coordinate data of the third marking point on the first hole pin alignment target and the coordinate data of the fourth marking point on the second hole pin alignment target; S18、将S17中的两个坐标数据转换到同一基准水平坐标系上;S18, converting the two coordinate data in S17 to the same reference horizontal coordinate system; S19、解析得到角度偏差方程。S19. Analyze and obtain the angle deviation equation.
CN202410931331.0A 2024-07-12 2024-07-12 Vertical thin cabin docking device and posture adjustment docking method based on three-phase machine measurement Active CN118456333B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202410931331.0A CN118456333B (en) 2024-07-12 2024-07-12 Vertical thin cabin docking device and posture adjustment docking method based on three-phase machine measurement

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202410931331.0A CN118456333B (en) 2024-07-12 2024-07-12 Vertical thin cabin docking device and posture adjustment docking method based on three-phase machine measurement

Publications (2)

Publication Number Publication Date
CN118456333A CN118456333A (en) 2024-08-09
CN118456333B true CN118456333B (en) 2024-09-10

Family

ID=92164258

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202410931331.0A Active CN118456333B (en) 2024-07-12 2024-07-12 Vertical thin cabin docking device and posture adjustment docking method based on three-phase machine measurement

Country Status (1)

Country Link
CN (1) CN118456333B (en)

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105081719A (en) * 2015-07-31 2015-11-25 北京星航机电装备有限公司 Spacecraft cabin automatic assembly system based on visual measurement and assembly method thereof
CN111442699A (en) * 2020-03-31 2020-07-24 中国科学院沈阳自动化研究所 An automatic docking device
CN112917142A (en) * 2021-04-06 2021-06-08 大连理工大学 Orthopedic posture-adjusting integrated butt-joint platform

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
FR1481273A (en) * 1966-04-08 1967-05-19 Commissariat Energie Atomique Device for checking the vertical alignment of two points located at different levels
US7113271B2 (en) * 2003-05-07 2006-09-26 Mark Vincent Loen Method to accurately measure the angular orientation of a rotating axis to a reference line
FR2876934B1 (en) * 2004-10-25 2007-02-02 Airbus France Sas DEVICE AND METHOD FOR ASSEMBLING ORIENTED OBJECTS
CN206580464U (en) * 2017-01-22 2017-10-24 艾雷奥特(江苏)飞机工业有限公司 Suitable for the suspension bracket of the vertical assembling of Small General Aircraft front open type canopy
CN107192343B (en) * 2017-07-04 2023-08-18 华中科技大学 Six-degree-of-freedom displacement measuring device and method for suspension characteristic test wheel
CN108356512B (en) * 2018-02-08 2020-02-18 北京卫星环境工程研究所 Precision docking process for self-leveling spacecraft
CN112756959B (en) * 2020-12-25 2023-03-31 南京晨光集团有限责任公司 Flexible multi-degree-of-freedom butt joint posture adjusting mechanism

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105081719A (en) * 2015-07-31 2015-11-25 北京星航机电装备有限公司 Spacecraft cabin automatic assembly system based on visual measurement and assembly method thereof
CN111442699A (en) * 2020-03-31 2020-07-24 中国科学院沈阳自动化研究所 An automatic docking device
CN112917142A (en) * 2021-04-06 2021-06-08 大连理工大学 Orthopedic posture-adjusting integrated butt-joint platform

Also Published As

Publication number Publication date
CN118456333A (en) 2024-08-09

Similar Documents

Publication Publication Date Title
CN111331367B (en) Intelligent Assembly Control System
CN110733617B (en) Cabin section assembling platform and cabin section assembling method
JP4021413B2 (en) Measuring device
CN1322961C (en) Metering device
CN112833786B (en) A cabin position and attitude measurement and alignment system, control method and application
WO2021003928A1 (en) Constant linear velocity control method for detecting contour of workpiece
CN212179808U (en) Automatic detection equipment for parts
CN106043736A (en) Series-parallel connection mechanical structure for posture adjustment of components of airplane and posture adjusting method
CN105806251A (en) Four-axis measuring system based on line laser sensor and measuring method thereof
CN105015800A (en) Automatic Assembly System of Spacecraft Modules on the Ground
CN113155047B (en) Long-distance hole distance measuring device and method, storage medium, equipment and rail vehicle
CN109434839A (en) A kind of robot self-calibrating method based on monocular vision auxiliary positioning
CN114770517B (en) Method for calibrating robot through point cloud acquisition device and calibration system
CN107036795B (en) Multifunctional debugging platform
CN118456333B (en) Vertical thin cabin docking device and posture adjustment docking method based on three-phase machine measurement
EP4037877B1 (en) A method for determining placement of parallel-kinematic machine joints, and a parallelkinematic machine with high stiffness
CN116295171B (en) Cradle type turntable assembly precision detection device and detection method
CN117048840A (en) Six-degree-of-freedom parallel mechanism-based aircraft cabin section docking method
CN112809037B (en) Method for drilling on curved surface structure
CN109807935B (en) An industrial robot arm strain detection device and method
CN206804283U (en) A kind of Multifunctional debugging platform
CN115870951B (en) Multi-robot flexible assembly and cooperative posture adjustment system
Muller et al. Towards the accuracy improvement of a mobile robot for large parts sanding
CN112213635B (en) Automatic loading and unloading device and system of motor test platform
CN117901047A (en) Flexible rail hole making system end effector and hole making method

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