A posture measurement method, system, device and measurement equipment

By installing a calibration device on intelligent equipment, using the total station to obtain the coordinates of four points to build a mark coordinate system, the problem of difficulty in obtaining the conversion relationship between the equipment coordinate system and the tunnel coordinate system in optical direct measurement method is solved, and efficient and accurate pose measurement is suitable for the application of intelligent equipment in digital tunnel construction.

CN114689057BActive Publication Date: 2024-11-08CHINA RAILWAY CONSTR HEAVY IND
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202210410308.8
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-04-19
Publication Date
2024-11-08
Estimated Expiration
2042-04-19

AI Technical Summary

Technical Problem

In the position measurement of intelligent equipment, the optical direct measurement method is prone to occlusion due to the limited position of the installation prism, which makes it impossible to obtain the accurate conversion relationship between the equipment coordinate system and the tunnel coordinate system, which is less practical.

Method used

By installing a calibration device on the equipment to be tested, the total station is used to obtain the coordinates of the four points of the calibration device under the target coordinate system, and a preset logo coordinate system is constructed, and the coordinate system between the coordinate system and the target coordinate system is The conversion matrix acquires the position of the device in the target coordinate system, allowing the calibration device to be installed in any position that is not blocked.

Benefits of technology

It realizes efficient and accurate acquisition of the position between the equipment and the tunnel coordinate system on intelligent equipment, improves the practicality and accuracy of measurement, and avoids the impact of occlusion problems.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN114689057B_ABST
    Figure CN114689057B_ABST
Patent Text Reader

Abstract

The present application discloses a posture measurement method, system, device and measuring equipment. In this scheme, the target coordinates of the first point, the second point, the third point and the fourth point calibrated by the calibration device in the target coordinate system are obtained by a total station, and then the preset marker coordinate system of the device to be measured is constructed, and the conversion matrix T1 between the target coordinate system and the preset marker coordinate system exists. The conversion matrix T2 exists between the preset marker coordinate system and the preset device coordinate system; the posture of the device to be measured in the target coordinate system is obtained by the conversion matrix T1*T2. Applied to the field of posture measurement, the conversion relationship between the preset device coordinate system and the target coordinate system is established through the preset marker coordinate system, and then the posture of the device to be measured can be obtained, and only one calibration device needs to be installed on the device to be measured, and the preset marker coordinate system can be constructed through the first point and the reflected second and third points. The installation position is free and can be installed in any position that will not be blocked, and the practicality is high.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of posture measurement, and in particular to a posture measurement method, system, device and measuring equipment. Background Art

[0002] In the process of digital construction of tunnels using intelligent equipment, there is a strong demand for accurate measurement of the position and posture between the intelligent equipment and the tunnel coordinate system. For example, in the process of digital construction of tunnels, in order to ensure that the intelligent equipment collects and records construction data information in real time, it is necessary to establish an accurate position and posture between the intelligent equipment and the tunnel coordinate system to ensure that the construction data information collected during the construction process is consistent with the actual construction data information, thereby guiding the construction and providing effective and reliable data information for subsequent quality inspections.

[0003] The posture measurement methods of intelligent equipment are usually divided into inertial measurement method, visual measurement method, electromagnetic measurement method, optical direct measurement method, etc. It is generally believed that the optical direct measurement method has the highest accuracy. In the optical direct measurement method, it is necessary to build a preset device coordinate system on the intelligent equipment. Conventionally, multiple targets are used to build the preset device coordinate system. Multiple prisms with a certain distance are installed on the intelligent equipment. The reflected light of the laser emitted by the total station to each prism determines the coordinates of each prism in the target coordinate system, such as the tunnel coordinate system, and then obtains the preset device coordinate system through the coordinates. Finally, the conversion relationship between the preset device coordinate system on the intelligent equipment and the tunnel coordinate system is obtained, that is, the posture.

[0004] Since there are limited positions on smart equipment where multiple prisms at a certain distance can be installed, there is a situation where the prism is blocked. For example, the robotic arm of the smart equipment may block the prism during movement. At this time, the total station cannot emit laser to the prism or receive the reflected light from the prism, and therefore cannot obtain the coordinates of the prism in the target coordinate system, and cannot obtain the preset device coordinate system through the coordinates, so its practicality is poor. Summary of the invention

[0005] The purpose of the present application is to provide a posture measurement method, system, device and measuring equipment. The scheme is applied to the field of posture measurement. Through a preset landmark coordinate system, a conversion relationship between a preset device coordinate system and a target coordinate system is established, so that the posture of the device to be measured in the target coordinate system can be obtained. Only a calibration device needs to be installed on the device to be measured. The preset landmark coordinate system can be constructed through the first point and the reflected second and third points. The installation position is free and can be installed in any position that will not be blocked, so it is highly practical.

[0006] In order to solve the above technical problems, the present application provides a posture measurement method, comprising:

[0007] Obtain target coordinates A, B, C and D of a first point, a second point, a third point and a fourth point calibrated by a calibration device in a target coordinate system through a total station, wherein the calibration device is installed on the device to be tested, and the calibration device includes a base with a volume smaller than a preset value, a first reflection module fixed to the base, and a second reflection module and a third reflection module fixed to the base to form a triangle with the base, the first point is located at the center of the first reflection module, the second point is located on a first baffle plate on which the second reflection module receives and reflects the laser emitted by the total station, the third point is located on a second baffle plate on which the third reflection module receives and reflects the laser emitted by the total station, and the fourth point is located on the total station;

[0008] The target coordinates A, B, C and D in the target coordinate system are used to construct the preset marker coordinate system of the device under test, and a conversion matrix T1 between the preset marker coordinate system and the device coordinate system preset for the device under test is obtained. A conversion matrix T2 exists between the preset marker coordinate system and the device coordinate system preset for the device under test;

[0009] The position and posture of the device under test in the target coordinate system is obtained through the transformation matrix T1*T2 between the preset device coordinate system and the target coordinate system, and the position and posture is the displacement and rotation change between the preset device coordinate system and the target coordinate system.

[0010] Preferably, a transparent shell is provided outside the second reflecting module and the third reflecting module which form a triangle with the base.

[0011] Preferably, before obtaining the target coordinates A, B, C and D of the first point, the second point, the third point and the fourth point calibrated by the calibration device in the target coordinate system by the total station, the method further includes:

[0012] The total station is controlled to set up a station in the target coordinate system, and the coordinates obtained by the total station after setting up the station are the target coordinates in the target coordinate system.

[0013] Preferably, obtaining target coordinates A, B, C and D of the first point, the second point, the third point and the fourth point calibrated by the calibration device in the target coordinate system by means of a total station comprises:

[0014] After the total station respectively transmits lasers to the first point, the second point, the third point and the fourth point calibrated by the calibration device and respectively receives reflected light, the target coordinates A, B, C and D in the target coordinate system are acquired.

[0015] Preferably, a scale is set on the first reflection module.

[0016] Preferably, the first baffle and the second baffle are objects capable of reflecting light around the device under test.

[0017] Preferably, constructing a preset marker coordinate system of the device under test through the target coordinates A, B, C and D in the target coordinate system, and acquiring a conversion matrix T1 between the target coordinate system and the target coordinate system includes:

[0018] S21: setting the target coordinate E of the fifth point on the second reflection module receiving the laser emitted by the total station in the target coordinate system and the target coordinate F of the sixth point on the third reflection module receiving the laser emitted by the total station in the target coordinate system to A;

[0019] S22: Acquire the landmark coordinates E0 of the fifth point in the preset landmark coordinate system and the landmark coordinates F0 of the sixth point in the preset landmark coordinate system;

[0020] S23: Through formula P X =(ED / |ED|+EB / |EB|) / |ED / |ED|+EB / |EB||Get the unit vector P in the X-axis direction of the preset marker coordinate system X ;

[0021] S24: By formula P R =(FD / |FD|+FC / |FC|) / |FD / |FD|+FC / |FC||Get the unit vector P on the preset marker coordinate system R ;

[0022] S25: Through formula P Z =P X ×P R Get the unit vector P in the Z-axis direction of the preset marker coordinate system Z ;

[0023] S26: Through formula P Y =P X ×P Z Get the unit vector P in the Y-axis direction of the preset marker coordinate system Y ;

[0024] S27: constructing the P of the marker coordinate system preset by the device under test X , the P Y and the P Z and the unit vectors on the X-axis, Y-axis and Z-axis of the target coordinate system to obtain the conversion matrix T1 between the preset marker coordinate system and the target coordinate system;

[0025] S28: Let E1 = T1*E0, F1 = T1*F0;

[0026] S29: By formula λ=|E1-E| 2 +|F1-F| 2 Obtain an error λ, and determine whether the error λ is less than a threshold value, if so, proceed to S31, if not, proceed to S30;

[0027] S30: Let E=E1, F=F1, and go to S23;

[0028] S31: Obtain a conversion matrix T1 between a preset marker coordinate system of the device under test and the target coordinate system.

[0029] In order to solve the above technical problems, the present application also provides a posture measurement system, including:

[0030] a target coordinate acquisition unit, used for acquiring target coordinates A, B, C and D of a first point, a second point, a third point and a fourth point calibrated by a calibration device in a target coordinate system through a total station, wherein the calibration device is installed on the device to be measured, and the calibration device comprises a base with a volume smaller than a preset value, a first reflection module fixed to the base, and a second reflection module and a third reflection module fixed to the base and forming a triangle with the base, the first point is located at the center of the first reflection module, the second point is located on a first baffle plate on which the second reflection module receives and reflects the laser emitted by the total station, the third point is located on a second baffle plate on which the third reflection module receives and reflects the laser emitted by the total station, and the fourth point is located on the total station;

[0031] A conversion matrix acquisition unit, used for constructing a preset marker coordinate system of the device under test through the target coordinates A, B, C and D in the target coordinate system, and acquiring a conversion matrix T1 between the preset marker coordinate system and the device coordinate system preset for the device under test, wherein a conversion matrix T2 exists between the preset marker coordinate system and the device coordinate system preset for the device under test;

[0032] The posture acquisition unit is used to obtain the posture of the device under test in the target coordinate system through the transformation matrix T1*T2 between the preset device coordinate system and the target coordinate system, and the posture is the displacement and rotation change between the preset device coordinate system and the target coordinate system.

[0033] In order to solve the above technical problems, the present application also provides a posture measurement device, comprising:

[0034] Memory for storing computer programs;

[0035] A processor is used to execute the computer program to implement the steps of the posture measurement method.

[0036] To solve the above technical problems, the present application also provides a measuring device, including a calibration device and a total station, and also including the posture measurement device, the total station is connected to the posture measurement device; the calibration device is installed on the device to be measured, and is used to calibrate a first point, a second point, a third point and a fourth point, the calibration device includes a base with a volume smaller than a preset value, a first reflection module fixed to the base, and a second reflection module and a third reflection module fixed to the base and forming a triangle with the base, the first point is located at the center of the first reflection module, the second point is located on the first baffle plate where the second reflection module receives the laser emitted by the total station and reflects it, the third point is located on the second baffle plate where the third reflection module receives the laser emitted by the total station and reflects it, and the fourth point is located on the total station; the total station is used to measure the target coordinates A, B, C and D of the first point, the second point, the third point and the fourth point calibrated by the calibration device in the target coordinate system, and send them to the posture measurement device.

[0037] The present application provides a posture measurement method, system, device and measuring equipment. In this scheme, the target coordinates of the first point, the second point, the third point and the fourth point calibrated by the calibration device in the target coordinate system are obtained by a total station, and then the preset marker coordinate system of the device to be measured is constructed, and the conversion matrix T1 between the preset marker coordinate system and the preset device coordinate system of the device to be measured is obtained. There is a conversion matrix T2 between the preset marker coordinate system and the preset device coordinate system of the device to be measured; the posture of the device to be measured in the target coordinate system is obtained by the conversion matrix T1*T2. Applied to the field of posture measurement, a conversion relationship between the preset device coordinate system and the target coordinate system is established through a preset marker coordinate system, and then the posture of the device to be measured in the target coordinate system can be obtained, and only one calibration device needs to be installed on the device to be measured, and the preset marker coordinate system can be constructed through the first point and the reflected second and third points. The installation position is free and can be installed in any position that will not be blocked, and the practicality is high. BRIEF DESCRIPTION OF THE DRAWINGS

[0038] In order to more clearly illustrate the technical solutions in the embodiments of the present application, the prior art and the drawings required for use in the embodiments will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.

[0039] Figure 1 A flow chart of a posture measurement method provided in this application;

[0040] Figure 2 A schematic diagram of the structure of a calibration device provided in this application;

[0041] Figure 3A schematic diagram of the structure of another calibration device provided in this application;

[0042] Figure 4 A structural schematic diagram of a posture transfer relationship provided for this application;

[0043] Figure 5 A schematic diagram of a process for obtaining a conversion matrix provided in this application;

[0044] Figure 6 A structural schematic diagram of a posture measurement system provided in this application;

[0045] Figure 7 A schematic diagram of the structure of a posture measurement device provided in this application;

[0046] Figure 8 A schematic diagram of the structure of a measuring device provided in this application. DETAILED DESCRIPTION

[0047] The core of this application is to provide a posture measurement method, system, device and measuring equipment. This solution is applied to the field of posture measurement. Through a preset landmark coordinate system, a conversion relationship between a preset device coordinate system and a target coordinate system is established, and then the posture of the device to be measured in the target coordinate system can be obtained. Only a calibration device needs to be installed on the device to be measured. The preset landmark coordinate system can be constructed through the first point and the reflected second and third points. The installation position is free and can be installed in any position that will not be blocked, so it is highly practical.

[0048] In order to make the purpose, technical solution and advantages of the embodiments of the present application clearer, the technical solution in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application. Obviously, the described embodiments are part of the embodiments of the present application, not all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of this application.

[0049] Please refer to Figure 1 , Figure 2 , Figure 3 and Figure 4 , Figure 1 A flow chart of a posture measurement method provided in this application, Figure 2 A schematic diagram of the structure of a calibration device provided in this application, Figure 3 A schematic diagram of the structure of another calibration device provided in this application, Figure 4 A structural schematic diagram of a posture transfer relationship provided in this application, a posture measurement method, including:

[0050] S11: Obtain target coordinates A, B, C and D of a first point, a second point, a third point and a fourth point calibrated by a calibration device in a target coordinate system through a total station, wherein the calibration device is installed on the device to be tested, and the calibration device includes a base with a volume smaller than a preset value, a first reflection module fixed to the base, and a second reflection module and a third reflection module fixed to the base and forming a triangle with the base, the first point is located at the center of the first reflection module, the second point is located on a first baffle plate where the second reflection module receives and reflects the laser emitted by the total station, the third point is located on a second baffle plate where the third reflection module receives and reflects the laser emitted by the total station, and the fourth point is located on the total station;

[0051] S12: constructing a preset marker coordinate system of the device under test through target coordinates A, B, C and D in the target coordinate system, and obtaining a conversion matrix T1 between the preset marker coordinate system and the device coordinate system preset for the device under test; a conversion matrix T2 exists between the preset marker coordinate system and the device coordinate system preset for the device under test;

[0052] S13: Obtain the position and posture of the device under test in the target coordinate system through the conversion matrix T1*T2 between the preset device coordinate system and the target coordinate system, where the position and posture is the displacement and rotation change between the preset device coordinate system and the target coordinate system.

[0053] In the process of digital construction of tunnels using intelligent equipment, there is a strong demand for accurate measurement of the position and posture between the intelligent equipment and the tunnel coordinate system. For example, in the process of digital construction of tunnels, in order to ensure that the intelligent equipment collects and records construction data information in real time, it is necessary to establish an accurate position and posture between the intelligent equipment and the tunnel coordinate system to ensure that the construction data information collected during the construction process is consistent with the actual construction data information, thereby guiding the construction and providing effective and reliable data information for subsequent quality inspections.

[0054] In the prior art, the posture measurement methods of intelligent equipment are generally divided into inertial measurement method, visual measurement method, electromagnetic measurement method, optical direct measurement method, etc. It is generally believed that the optical direct measurement method has the highest accuracy. In the optical direct measurement method, it is necessary to build a preset device coordinate system on the intelligent equipment. Conventionally, multiple targets are used to build the preset device coordinate system. Multiple prisms with a certain distance are installed on the intelligent equipment. The reflected light of the laser emitted by the total station to each prism determines the coordinates of each prism in the target coordinate system, such as the tunnel coordinate system, and then the preset device coordinate system is obtained through the coordinates. Finally, the conversion relationship between the preset device coordinate system on the intelligent equipment and the tunnel coordinate system is obtained, that is, the posture. Since the positions where multiple prisms with a certain distance can be installed on the intelligent equipment are limited, there is a situation where the prism is blocked. For example, the mechanical arm of the intelligent equipment may block the prism during movement. At this time, the total station cannot emit laser to the prism or receive the reflected light of the prism, and it is also impossible to obtain the coordinates of the prism in the target coordinate system. It is impossible to obtain the preset device coordinate system through the coordinates, and the practicality is poor.

[0055] In this application, the ultimate goal is also to obtain the conversion relationship between the preset device coordinate system and the target coordinate system, that is, to obtain the position and posture of the device to be tested. Specifically, the device to be tested can be an intelligent equipment used in the digital construction process of the tunnel, and the target coordinate system is the tunnel coordinate system (set manually according to needs). The intelligent device can measure the construction data in the tunnel through a movable detection point. When the intelligent device obtains the device coordinates of the movable detection point in the preset device coordinate system through its own preset device coordinate system, and then obtains the target coordinates of the movable detection point in the target coordinate system through the conversion relationship between the preset device coordinate system and the target coordinate system, that is, the position and posture of the device to be tested, so as to obtain the position of the movable detection point in the tunnel, and avoid the inconvenience caused by the dynamic detection of the target coordinates of the movable detection point through the position and posture of the device to be tested. In this application, by constructing a preset marker coordinate system as a bridge, the conversion relationship between the preset device coordinate system and the target coordinate system, that is, the position and posture of the device to be tested, is indirectly obtained.

[0056] Specifically, since the device under test has a preset marker coordinate system and a preset device coordinate system, and there is a preset conversion matrix T2 between the preset marker coordinate system and the preset device coordinate system, after the preset marker coordinate system is constructed and the conversion matrix T1 between it and the target coordinate system is obtained, the conversion relationship between the preset device coordinate system and the target coordinate system, that is, the posture of the device under test, can be obtained from the conversion matrix T1*T2. T1*T2 also represents the transfer relationship of the posture. Figure 4 The preset mark coordinate system and the preset device coordinate system are both pre-set for the device under test (the preset mark coordinate system is known, and the preset device coordinate system is unknown), while the target coordinate system is independent of the device under test and is set by the operator according to needs.

[0057] Regarding how to construct a preset marker coordinate system, this application creates a calibration device that is installed on the device to be tested. One calibration device can realize the construction of a preset marker coordinate system, so there is a freer installation position and it is not easy to be blocked. Figure 2The calibration device includes a base with a volume smaller than a preset value (which can be installed on the device to be tested and combined with the device to be tested to form a rigid body), a first reflection module fixed to the base, and a second reflection module and a third reflection module fixed to the base to form a triangle with the base. The base supports the device thereon. The overall structure is simple, and a single target is used to construct a preset mark coordinate system. That is, only one measurement target, i.e., the first point, needs to be calibrated on the device to be tested. The other three points for determining the preset mark coordinate system: the second point is generated by reflection from the second reflection module, the third point is generated by reflection from the third reflection module, and the fourth point is located on the total station. They are all calibrated outside the device to be tested. The calibration device is a passive device with a small, simple and light size and is easy to install. After calibrating the corresponding points, the 6-DOF posture of the device to be tested in any scenario can be quickly and accurately measured in conjunction with a single total station.

[0058] The volume of the base is limited in order to make the positions of the first reflection module, the second reflection module and the third reflection module more compact, on the one hand to reduce the space occupied by the calibration device; on the other hand, Figure 3 , the target coordinate A can be approximately taken as the coordinate of the point on the second reflection module that receives and reflects the laser emitted by the total station (for example Figure 3 The target coordinates E) and the coordinates of the point on the third reflection module that receives the laser emitted by the total station and reflects it (for example Figure 3 The target coordinate F) is used as the coordinate of the origin of the preset mark coordinate system. The angle between the second reflection module and the third reflection module is determined according to the actual situation, and approximately 90 degrees is the best.

[0059] It should be noted that due to the structure of the calibration device, the angle of the laser emitted by the total station to the second reflection module and the third reflection module can be small. At this time, it has no effect on the preset calibration coordinate system constructed by the second point and the third point of reflection. It is suitable for the situation where the space where the device to be tested is small, and can effectively improve the positioning accuracy of small angles in a narrow space, reduce the error of the total station in small-angle target positioning, improve the accuracy of posture measurement, and also reduce the measurement difficulty of front-line personnel. However, in the prior art, when the distance between multiple prisms set on the device to be tested is small, the angle of the laser emitted by the total station to the multiple prisms is small, and a three-dimensional preset device coordinate system cannot be constructed. Therefore, a certain distance is required between the multiple prisms. When the coordinates of the prisms are obtained by the total station, they may be limited by the space where the device to be tested is located, and it is not easy to obtain.

[0060] In addition, the first reflection module, the second reflection module and the third reflection module can be made of lenses or prisms, or any other material capable of reflecting laser light; the shape of the first reflection module can be circular, and the shape of the second reflection module and the third reflection module can be the same rectangular shape, which is not particularly limited here. When the total station emits laser light to the first reflection module, the second reflection module and the third reflection module, it can be aimed at the center of each of them.

[0061] In summary, the present application provides a posture measurement method, in which the target coordinates of the first point, the second point, the third point and the fourth point calibrated by the calibration device in the target coordinate system are obtained through a total station, and then the preset marker coordinate system of the device to be tested is constructed, and the conversion matrix T1 between the preset marker coordinate system and the preset device coordinate system of the device to be tested is obtained, and a conversion matrix T2 exists between the preset marker coordinate system and the preset device coordinate system of the device to be tested; the posture of the device to be tested in the target coordinate system is obtained through the conversion matrix T1*T2. Applied to the field of posture measurement, a conversion relationship between the preset device coordinate system and the target coordinate system is established through a preset marker coordinate system, and then the posture of the device to be tested in the target coordinate system can be obtained, and only one calibration device needs to be installed on the device to be tested, and the preset marker coordinate system can be constructed through the first point and the reflected second and third points. The installation position is free, and it can be installed in any position that will not be blocked, and it is highly practical.

[0062] Based on the above embodiments:

[0063] As a preferred embodiment, a transparent shell is provided outside the second reflecting module and the third reflecting module which form a triangle with the base.

[0064] In this embodiment, please refer to Figure 2 The second reflection module, the third reflection module and the base form a triangle. In order to protect the second reflection module and the third reflection module and avoid external collision, a transparent shell can be set outside the triangle. Specifically, it can be a rectangular transparent shell, which does not affect the reception and reflection of laser while protecting.

[0065] As a preferred embodiment, before obtaining the target coordinates A, B, C and D of the first point, the second point, the third point and the fourth point calibrated by the calibration device in the target coordinate system through the total station, it also includes:

[0066] The total station is controlled to set up a station in the target coordinate system. The coordinates obtained by the total station after setting up the station are the target coordinates in the target coordinate system.

[0067] In this embodiment, in order to obtain the target coordinates in the target coordinate system through the total station, it is necessary to control the total station to set up a station in the target coordinate system in advance, that is, the relevant settings of the target coordinate system can be input into the total station in advance, so that the total station can measure the target coordinates of a certain point based on the target coordinate system.

[0068] As a preferred embodiment, obtaining target coordinates A, B, C and D of the first point, the second point, the third point and the fourth point calibrated by the calibration device in the target coordinate system by a total station includes:

[0069] After the total station respectively transmits lasers to the first point, the second point, the third point and the fourth point calibrated by the calibration device and respectively receives reflected light, the target coordinates A, B, C and D in the target coordinate system are obtained.

[0070] In this embodiment, after the calibration device calibrates the first point, the second point, the third point and the fourth point, the specific method of obtaining the target coordinates of the calibrated points through the total station is that the total station is aimed at the calibrated first point and emits a laser to it. After receiving the emitted light, the target coordinate A of the first point can be measured by the received reflected light, and the target coordinates B, C and D of the second point, the third point and the fourth point can be obtained by the same logic.

[0071] As a preferred embodiment, a scale is set on the first reflection module.

[0072] In this embodiment, reference can be made to Figure 2 Taking the first reflection module as a circle as an example, a scale is set on the cross lines on the first reflection module. The center of the first reflection module can be calibrated as the first point through the scale, so that the first point calibrated by the calibration device is more accurate and the error is reduced; in addition, scales can also be set on the second reflection module and the third reflection module.

[0073] As a preferred embodiment, the first baffle and the second baffle are objects capable of reflecting light around the device under test.

[0074] In this embodiment, the second point calibrated by the calibration device is located at the first baffle, and the third point calibrated is located at the second baffle. Considering that the target coordinates of the second point and the third point are subsequently obtained by the total station, the first baffle and the second baffle must be able to reflect the laser. The first baffle and the second baffle here can be directly objects around the device to be tested that can reflect the laser emitted by the total station, or they can be artificially set, such as a reflector, and are not specifically limited here.

[0075] Please refer to Figure 5 , Figure 5 A schematic diagram of a process for obtaining a conversion matrix provided in this application.

[0076] As a preferred embodiment, a marker coordinate system preset by the device under test is constructed by using the target coordinates A, B, C and D in the target coordinate system, and a conversion matrix T1 between the target coordinate system and the target coordinate system is obtained, including:

[0077] S21: setting the target coordinate E of the fifth point on the second reflection module receiving the laser emitted by the total station in the target coordinate system and the target coordinate F of the sixth point on the third reflection module receiving the laser emitted by the total station in the target coordinate system to A;

[0078] S22: Obtaining the marker coordinates E0 of the fifth point in the preset marker coordinate system and the marker coordinates F0 of the sixth point in the preset marker coordinate system;

[0079] S23: Through formula P X =(ED / |ED|+EB / |EB|) / |ED / |ED|+EB / |EB||Get the unit vector P in the X-axis direction of the preset marker coordinate system X ;

[0080] S24: By formula P R =(FD / |FD|+FC / |FC|) / |FD / |FD|+FC / |FC||Get the unit vector P on the preset sign coordinate system R ;

[0081] S25: Through formula P Z =P X ×P R Get the unit vector P in the Z-axis direction of the preset marker coordinate system Z ;

[0082] S26: Through formula P Y =P X ×P Z Get the unit vector P in the Y-axis direction of the preset marker coordinate system Y ;

[0083] S27: By constructing the P of the marker coordinate system preset by the device under test X , P Y and P Z and the unit vectors on the X-axis, Y-axis and Z-axis of the target coordinate system to obtain the conversion matrix T1 between the preset marker coordinate system and the target coordinate system;

[0084] S28: Let E1 = T1*E0, F1 = T1*F0;

[0085] S29: By formula λ=|E1-E| 2 +|F1-F| 2Obtain the error λ and determine whether the error λ is less than a threshold value. If so, proceed to S31; if not, proceed to S30;

[0086] S30: Let E=E1, F=F1, and go to S23;

[0087] S31: Obtain a conversion matrix T1 between a preset marker coordinate system of the device under test and a target coordinate system.

[0088] In this embodiment, an iterative algorithm is used to obtain the conversion matrix T1. For details, refer to Figure 3 , since the volume of the base is smaller than the preset value, the distances from the second reflection module and the third reflection module to the first reflection module are ignored at this time, and the target coordinate A is approximately taken as the target coordinate E of the fifth point and the target coordinate F of the sixth point in S11, and the target coordinate A is taken as the coordinate of the origin of the preset marker coordinate system; in S12, the marker coordinates E0 and the marker coordinates F0 of the fifth point and the sixth point in the preset marker coordinate system can be obtained by manual measurement; the preset marker coordinate system is constructed through S23 to S26: in S23, the unit vector P on the angular bisector between the incident laser and the reflected laser generated by the laser emitted by the total station on the second reflection module is obtained through vector ED and vector EB in the target coordinate system. X , and use it as the unit vector in the X-axis direction of the preset marker coordinate system; in S24, the unit vector P in the target coordinate system on the angular bisector between the incident laser and the reflected laser generated by the laser emitted by the total station on the third reflection module is obtained through vector FD and vector FC. R ; In S25, due to the unit vector P R With the unit vector P X are all located in the same plane, such as the XY plane, and are not parallel. In this case, the unit vector P R Cross product unit vector P X You can get the unit vector P perpendicular to the XY plane Z , and use it as the unit vector in the Z-axis direction of the preset marker coordinate system; in S26, the unit vector P in the X-axis direction of the preset marker coordinate system X and the unit vector P in the Z-axis direction Z All of them have been obtained, and the unit vector P in the Y-axis direction of the preset landmark coordinate system can be obtained by cross-multiplying them. Y ; At this point, the preset landmark coordinate system has been constructed.

[0089] Then, in S27, P X , P Y and P ZA vector matrix is ​​constructed, and the unit vectors on the X-axis, Y-axis and Z-axis of the target coordinate system (the target coordinate system is artificially set, and the unit vectors on the X-axis, Y-axis and Z-axis are known) are also constructed into a vector matrix, and the conversion matrix T1 between the two vector matrices is obtained; then, S28 obtains the target coordinates E1 and F1 in the target coordinate system through the conversion matrix T1 respectively using the marker coordinates E0 and marker coordinates F0 obtained in S22; in S29, the error between E1 obtained through the conversion matrix T1 and E which is approximately equal to A at the beginning is obtained, and the error between F1 and F is obtained in the same way. When the sum of the two errors is not less than the threshold, it is necessary to set E=E1, F=F1 in S30, and use this to reconstruct the preset marker coordinate system, until the error between the target coordinates of the point obtained by the marker coordinates and the conversion matrix T1 and the target coordinates of the same point for constructing the preset marker coordinate system is less than the threshold, and then the conversion matrix T1 is output, and a more accurate conversion matrix T1 is obtained through an iterative algorithm.

[0090] Please refer to Figure 6 , Figure 6 A structural schematic diagram of a posture measurement system provided for this application includes:

[0091] A target coordinate acquisition unit 1 is used to acquire target coordinates A, B, C and D of a first point, a second point, a third point and a fourth point calibrated by a calibration device in a target coordinate system through a total station, wherein the calibration device is installed on the device to be measured, and the calibration device includes a base with a volume smaller than a preset value, a first reflection module fixed to the base, and a second reflection module and a third reflection module fixed to the base and forming a triangle with the base, the first point is located at the center of the first reflection module, the second point is located on a first baffle plate where the second reflection module receives and reflects the laser emitted by the total station, the third point is located on a second baffle plate where the third reflection module receives and reflects the laser emitted by the total station, and the fourth point is located on the total station;

[0092] The conversion matrix acquisition unit 2 is used to construct the preset mark coordinate system of the device under test through the target coordinates A, B, C and D in the target coordinate system, and obtain the conversion matrix T1 between the target coordinate system and the preset device coordinate system of the device under test. There is a conversion matrix T2 between the preset mark coordinate system and the preset device coordinate system of the device under test;

[0093] The posture acquisition unit 3 is used to acquire the posture of the device under test in the target coordinate system through the conversion matrix T1*T2 between the preset device coordinate system and the target coordinate system. The posture is the displacement and rotation change between the preset device coordinate system and the target coordinate system.

[0094] For an introduction to a posture measurement system provided in this application, please refer to the above-mentioned embodiment, and this application will not go into details here.

[0095] Please refer to Figure 7, Figure 7 A schematic diagram of the structure of a posture measurement device provided in this application includes:

[0096] Memory 4, used for storing computer programs;

[0097] The processor 5 is used to execute the computer program to implement the steps of the posture measurement method.

[0098] For an introduction to a posture measurement device provided in this application, please refer to the above-mentioned embodiment, and this application will not go into details here.

[0099] Please refer to Figure 8 , Figure 8 A structural schematic diagram of a measuring device provided for the present application includes a calibration device 6 and a total station 7, and also includes a posture measurement device 8, the total station 7 is connected to the posture measurement device 8; the calibration device 6 is installed on the device to be measured, and is used to calibrate a first point, a second point, a third point and a fourth point, the calibration device 6 includes a base with a volume smaller than a preset value, a first reflection module fixed to the base, and a second reflection module and a third reflection module fixed to the base and forming a triangle with the base, the first point is located at the center of the first reflection module, the second point is located on the first baffle plate where the second reflection module receives the laser emitted by the total station 7 and reflects it, the third point is located on the second baffle plate where the third reflection module receives the laser emitted by the total station 7 and reflects it, and the fourth point is located on the total station 7; the total station 7 is used to measure the target coordinates A, B, C and D of the first point, the second point, the third point and the fourth point calibrated by the calibration device 6 in the target coordinate system, and send them to the posture measurement device 8.

[0100] For an introduction to the posture measurement device 8 in a measuring device provided in the present application, please refer to the above-mentioned embodiment, and the present application will not go into details here.

[0101] It should be noted that, in this specification, the terms "include", "comprises" or any other variants thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, article or device. In the absence of further restrictions, an element defined by the sentence "comprises a ..." does not exclude the existence of other identical elements in the process, method, article or device including the element.

[0102] The above description of the disclosed embodiments enables those skilled in the art to implement or use the present application. Various modifications to these embodiments will be apparent to those skilled in the art, and the general principles defined herein may be implemented in other embodiments without departing from the spirit or scope of the present application. Therefore, the present application will not be limited to the embodiments shown herein, but will conform to the widest scope consistent with the principles and novel features disclosed herein.

Claims

1. A posture measurement method, characterized in that: include: Obtain target coordinates A, B, C and D of a first point, a second point, a third point and a fourth point calibrated by a calibration device in a target coordinate system through a total station, wherein the calibration device is installed on the device to be tested, and the calibration device includes a base with a volume smaller than a preset value, a first reflection module fixed to the base, and a second reflection module and a third reflection module fixed to the base to form a triangle with the base, the first point is located at the center of the first reflection module, the second point is located on a first baffle plate on which the second reflection module receives and reflects the laser emitted by the total station, the third point is located on a second baffle plate on which the third reflection module receives and reflects the laser emitted by the total station, and the fourth point is located on the total station; Constructing a preset marker coordinate system of the device under test through the target coordinates A, B, C and D in the target coordinate system, and obtaining a conversion matrix T1 between the preset marker coordinate system and the device coordinate system preset for the device under test, and a conversion matrix T2 exists between the preset marker coordinate system and the device coordinate system preset for the device under test; The position and posture of the device under test in the target coordinate system is obtained through the transformation matrix T1*T2 between the preset device coordinate system and the target coordinate system, and the position and posture is the displacement and rotation change between the preset device coordinate system and the target coordinate system.

2. The posture measurement method according to claim 1, characterized in that: A transparent housing is disposed outside the second reflecting module and the third reflecting module which form a triangle with the base.

3. The posture measurement method according to claim 1, characterized in that: Before obtaining the target coordinates A, B, C and D of the first point, the second point, the third point and the fourth point calibrated by the calibration device in the target coordinate system through the total station, it also includes: The total station is controlled to set up a station in the target coordinate system, and the coordinates obtained by the total station after setting up the station are the target coordinates in the target coordinate system.

4. The posture measurement method according to claim 1, characterized in that: The target coordinates A, B, C and D of the first point, the second point, the third point and the fourth point calibrated by the calibration device in the target coordinate system are obtained by the total station, including: After the total station respectively emits lasers to the first point, the second point, the third point and the fourth point calibrated by the calibration device and respectively receives reflected light, the target coordinates A, B, C and D in the target coordinate system are acquired.

5. The posture measurement method according to claim 1, characterized in that: A scale is set on the first reflection module.

6. The posture measurement method according to claim 1, characterized in that: The first baffle and the second baffle are objects capable of reflecting light around the device under test.

7. The posture measurement method according to any one of claims 1 to 6, characterized in that: The target coordinates A, B, C and D in the target coordinate system are used to construct the marker coordinate system preset by the device under test, and the conversion matrix T1 between the target coordinate system and the target coordinate system is obtained, including: S21: setting the target coordinate E of the fifth point on the second reflection module receiving the laser emitted by the total station in the target coordinate system and the target coordinate F of the sixth point on the third reflection module receiving the laser emitted by the total station in the target coordinate system to A; S22: Acquire the landmark coordinates E0 of the fifth point in the preset landmark coordinate system and the landmark coordinates F0 of the sixth point in the preset landmark coordinate system; S23: Through formula P X =(ED / |ED|+EB / |EB|) / |ED / |ED|+EB / |EB||Get the unit vector P in the X-axis direction of the preset marker coordinate system X ; S24: By formula P R =(FD / |FD|+FC / |FC|) / |FD / |FD|+FC / |FC||Get the unit vector P on the preset marker coordinate system R ; S25: Through formula P Z =P X ×P R Get the unit vector P in the Z-axis direction of the preset marker coordinate system Z ; S26: Through formula P Y =P X ×P Z Get the unit vector P in the Y-axis direction of the preset marker coordinate system Y ; S27: constructing the P of the marker coordinate system preset by the device under test X , the P Y and the P Z and the unit vectors on the X-axis, Y-axis and Z-axis of the target coordinate system to obtain the conversion matrix T1 between the preset marker coordinate system and the target coordinate system; S28: Let E1 = T1*E0, F1 = T1*F0; S29: By formula λ=|E1-E| 2 +|F1-F| 2 Obtain an error λ, and determine whether the error λ is less than a threshold value, if so, proceed to S31, if not, proceed to S30; S30: Let E=E1, F=F1, and go to S23; S31: Obtain a conversion matrix T1 between a preset marker coordinate system of the device under test and the target coordinate system.

8. A posture measurement system, characterized in that: include: a target coordinate acquisition unit, used for acquiring target coordinates A, B, C and D of a first point, a second point, a third point and a fourth point calibrated by a calibration device in a target coordinate system through a total station, wherein the calibration device is installed on the device to be measured, and the calibration device comprises a base with a volume smaller than a preset value, a first reflection module fixed to the base, and a second reflection module and a third reflection module fixed to the base and forming a triangle with the base, the first point is located at the center of the first reflection module, the second point is located on a first baffle plate on which the second reflection module receives and reflects the laser emitted by the total station, the third point is located on a second baffle plate on which the third reflection module receives and reflects the laser emitted by the total station, and the fourth point is located on the total station; A conversion matrix acquisition unit, used for constructing a preset marker coordinate system of the device under test through the target coordinates A, B, C and D in the target coordinate system, and acquiring a conversion matrix T1 between the preset marker coordinate system and the device coordinate system preset for the device under test, wherein a conversion matrix T2 exists between the preset marker coordinate system and the device coordinate system preset for the device under test; The posture acquisition unit is used to obtain the posture of the device under test in the target coordinate system through the transformation matrix T1*T2 between the preset device coordinate system and the target coordinate system, and the posture is the displacement and rotation change between the preset device coordinate system and the target coordinate system.

9. A posture measurement device, characterized in that: include: Memory for storing computer programs; A processor, configured to execute the computer program to implement the steps of the posture measurement method as described in any one of claims 1 to 7.

10. A measuring device, characterized in that: It includes a calibration device and a total station, and also includes the posture measurement device as claimed in claim 9, the total station is connected to the posture measurement device; the calibration device is installed on the device to be measured, and is used to calibrate a first point, a second point, a third point and a fourth point. The calibration device includes a base with a volume smaller than a preset value, a first reflection module fixed to the base, and a second reflection module and a third reflection module fixed to the base and forming a triangle with the base, the first point is located at the center of the first reflection module, the second point is located on the first baffle plate where the second reflection module receives and reflects the laser emitted by the total station, the third point is located on the second baffle plate where the third reflection module receives and reflects the laser emitted by the total station, and the fourth point is located on the total station; the total station is used to measure the target coordinates A, B, C and D of the first point, the second point, the third point and the fourth point calibrated by the calibration device in the target coordinate system, and send them to the posture measurement device.