Coordinate system accurate registration device and method of motion capture system
Through the T-type probe device and the ICP point cloud matching algorithm, the high-precision coordinate system registration of the motion capture system is realized, solving the problem of matching object coordinate system and three-dimensional physical model, and improving the measurement accuracy and application range.
Patent Information
- Application Number
- CN202410535840.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-04-30
- Publication Date
- 2024-11-08
AI Technical Summary
Motion capture systems are difficult to achieve precise matching between the object coordinate system and the three-dimensional physical model in tasks such as assembly, processing and motion simulation, resulting in insufficient measurement accuracy and inability to meet high-precision requirements.
The T-type probe device is used to calibrate the probe coordinate system through ball-socket calibration tooling and spherical fitting methods, and the ICP point cloud matching algorithm is used to accurately match the measurement coordinate system and the object body coordinate system to achieve high-precision registration.
The sub-mm-level precise registration of the measurement coordinate system of the motion capture system and the three-dimensional physical model is realized, reducing the target ball radius and manual pasting errors, expanding the application range, and meeting the needs of complex tasks.
Smart Images

Figure CN118913088A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of positioning and measuring systems, and in particular to a coordinate system precise registration device and method for a motion capture system. Background Art
[0002] The motion capture system is a positioning and measurement system based on vision. It uses multiple fixed infrared cameras at different angles to receive infrared rays emitted or reflected by the target ball on the object, and combines relevant algorithms to establish the rigid body of the object and locate it in real time. It can measure multiple objects within the range in real time. At present, its measurement accuracy can reach below the millimeter level. With the development of related technologies, the application fields of motion capture systems have gradually increased, and now they have begun to appear in application scenarios such as kinematic simulation, precision assembly, and intelligent processing. These applications often have high precision requirements, and a problem arises, that is, the coordinate system established by the system for the object is difficult to accurately match with its three-dimensional physical model. For example, in the assembly of aircraft parts, it is necessary to obtain the precise position of some important key points or positioning points on the surface or inside of the parts in real time. These points can correspond to the three-dimensional physical model, and the positioning points are marked during the processing process. Because the radius of the target ball can reach about 1 cm, and it is manually pasted to the surface of the part, the deviation between the measured target ball position and the actual position of the positioning point can reach more than 1 cm, and the object measurement coordinate system established by the measurement system has a large deviation from the body coordinate system in the three-dimensional physical model, which is difficult to meet the accuracy requirements of tasks such as assembly, processing, and motion simulation. In this case, a device and method are needed to align the measurement coordinate system in the motion capture system with the coordinate system of the object body, so as to expand the application scope of the motion capture system. According to the survey, there is currently no solution to this problem. Summary of the invention
[0003] In view of the problems existing in the background technology, the purpose of the present invention is to provide a coordinate system precise alignment device and method for a motion capture system, so that the measurement coordinate system established by the motion capture system for the object to be measured can be accurately matched with the three-dimensional physical model of the object to be measured, so as to meet the accuracy requirements of tasks such as assembly, processing, and motion simulation, and expand the application scope of the motion capture system.
[0004] According to the first aspect of the present invention, the precise coordinate alignment device for the motion capture system is a T-shaped probe, comprising:
[0005] A plate, one side of which is provided with infrared emitting modules, wherein there are at least three infrared emitting modules which are asymmetrically distributed;
[0006] A probe, one end of which is fixed to the plate, and the other end of which is fixed with a rigid ball.
[0007] When the coordinate system precise registration device of the motion capture system of the first aspect of the present invention is used for registration, a calibration step and a matching step are required. Among them, in the calibration step: first establish a T-type probe coordinate system, establish a probe rigid body for at least three infrared emission modules in the motion capture system, and take the target point of one of the infrared emission modules as the origin; then place the rigid ball of the T-type probe in the concave surface of the ball socket calibration tooling, keep the position of the rigid ball fixed, transform the posture of the T-type probe, and use the motion capture system to measure the posture of at least four groups of T-type probe coordinate systems; then use the least squares method to perform spherical fitting on the origin of at least four groups of T-type probes with different postures, and obtain the spherical shape of the rigid ball. The precise position of the center in the T-probe coordinate system; in the matching link: place the rigid ball of the T-probe at the positioning point of the rigid object to be measured, and calculate the coordinates of the positioning point from the T-probe posture and calibration results; perform ICP point cloud matching on the coordinates of at least three positioning points on the rigid object to be measured and the coordinates of the positioning points in the coordinate system of the three-dimensional physical model of the rigid object to be measured, and calculate the optimal transformation matrix, thereby completing the high-precision registration of the measurement coordinate system of the rigid object to be measured in the motion capture system with the body coordinate system in its three-dimensional physical model, and its accuracy can reach sub-millimeter level. At this time, the precise position of any point of the rigid object to be measured can be indirectly measured according to the three-dimensional physical model, and the sub-millimeter accuracy of the motion capture system itself can be achieved. This greatly reduces the centimeter-level error caused by factors such as the radius of the target ball and the manual pasting method in the existing technology, expands the application scope of the motion capture system, and can meet the needs of more complex tasks.
[0008] According to the first aspect of the present invention, the precise registration device of the coordinate system of the motion capture system has the following advantages: the special T-type probe is calibrated by the ball-and-socket calibration tool and the spherical fitting method, so that the motion capture system can measure the precise position of the surface positioning point (including the obscured point) of the rigid object; the positioning point measurement value is matched with the positioning point coordinate in the three-dimensional physical model by the ICP algorithm, and finally the precise conversion relationship between the measurement coordinate system and the object body coordinate system is obtained, and its accuracy can reach the sub-millimeter level, so as to realize the high-precision registration of the measurement coordinate system in the motion capture system with the body coordinate system in its three-dimensional physical model, so as to indirectly measure the precise position of any point of the corresponding three-dimensional physical model, which is helpful to promote the application of the motion capture system in many fields such as intelligent assembly, processing, motion simulation, digital twin, etc. In addition, the asymmetric distribution structure of the target point of the T-type probe effectively avoids the system's misidentification and makes full use of the space of the plate, and the structure of the T-type probe also enables it to measure the obscured positioning point. Furthermore, the calibration method based on spherical fitting and the point cloud matching method based on ICP effectively reduce the influence of measurement error on the registration result.
[0009] In some embodiments, the panel is a composite panel.
[0010] In some embodiments, the probe is a stainless steel probe.
[0011] In some embodiments, a power supply module and a switch are provided on the other side of the plate, the power supply module is used to supply power to the infrared emitting module, and the switch is used to control the infrared emitting module to be powered on or off.
[0012] In some embodiments, a handle is provided on the plate.
[0013] In some embodiments, the hand-held portion is a through hole provided on the plate.
[0014] In some embodiments, there are six infrared emitting modules, wherein among the six infrared emitting modules, some of the infrared emitting modules are fixed on the plate through a base, and some of the infrared emitting modules are directly fixed on the plate.
[0015] According to the coordinate system precise registration method of the motion capture system of the second embodiment of the present invention, the coordinate system precise registration device of the motion capture system of the first embodiment of the present invention is used for registration, and the method comprises the following steps:
[0016] Calibration step: firstly, establish the coordinate system of the T-type probe, establish a probe rigid body for at least three of the infrared light emitting modules in the motion capture system, and take one of the infrared light emitting modules as the origin; then place the rigid ball of the T-type probe in the concave surface of the ball socket calibration tooling, keep the position of the rigid ball unchanged, change the posture of the T-type probe, and use the motion capture system to measure at least four groups of postures of the T-type probe coordinate system; then use the least squares method to perform spherical fitting on the origin of at least four groups of T-type probes with different postures, and obtain the precise position of the center of the rigid ball in the T-type probe coordinate system;
[0017] Matching step: place the rigid ball of the T-type probe at the positioning point of the rigid object to be measured, and calculate the coordinates of the positioning point based on the posture of the T-type probe and the calibration result; perform ICP point cloud matching on the coordinates of at least three positioning points and the coordinates of the positioning points in the three-dimensional physical model of the rigid object to be measured, and calculate the optimal transformation matrix, thereby completing the precise alignment of the coordinate system.
[0018] According to the method for accurate registration of the coordinate system of the motion capture system of the second embodiment of the present invention, it has the following advantages: the special T-type probe is calibrated by the ball-and-socket calibration tooling and the spherical fitting method, so that the motion capture system can measure the precise position of the surface positioning point (including the obscured point) of the rigid object; the positioning point measurement value is matched with the three-dimensional physical model by the ICP algorithm, and finally the precise conversion relationship between the measurement coordinate system and the object body coordinate system is obtained, and its accuracy can reach the sub-millimeter level, so as to realize the high-precision registration of the measurement coordinate system in the motion capture system with the body coordinate system in its three-dimensional physical model, so as to indirectly measure the precise position of any point of the corresponding three-dimensional physical model, which is helpful to promote the application of the motion capture system D in many fields such as intelligent assembly, processing, motion simulation, digital twin, etc. In addition, the asymmetric distribution structure of the target point of the T-type probe effectively avoids the system's misidentification and makes full use of the space of the plate, and the structure of the T-type probe also enables it to measure the obscured positioning point. Furthermore, the calibration method based on spherical fitting and the point cloud matching method based on ICP effectively reduce the influence of measurement error on the registration result.
[0019] In some embodiments, the concave surface of the calibration tool is a conical surface.
[0020] In some embodiments, in the calibration step, the infrared light target point farthest from the center of the rigid ball is used as the origin.
[0021] Additional aspects and advantages of the present invention will be given in part in the following description and in part will be obvious from the following description, or will be learned through practice of the present invention. BRIEF DESCRIPTION OF THE DRAWINGS
[0022] The above and / or additional aspects and advantages of the present invention will become apparent and easily understood from the description of the embodiments in conjunction with the following drawings, in which:
[0023] Figure 1 A side schematic diagram of a coordinate system precise registration device for a motion capture system of the present invention;
[0024] Figure 2 Another side schematic diagram of the coordinate system precise registration device of the motion capture system of the present invention;
[0025] Figure 3 It is a schematic diagram of the calibration link in the coordinate system precise registration method of the motion capture system of the present invention;
[0026] Figure 4 It is another schematic diagram of the calibration link in the coordinate system precise registration method of the motion capture system of the present invention;
[0027] Figure 5It is a schematic diagram of the matching link in the coordinate system precise registration method of the motion capture system of the present invention.
[0028] Reference numerals:
[0029] T-type probe 100; plate 10; infrared emitting module 11; base 12; hand-held part 13; power supply module 14; probe 15; rigid ball 16; sphere center 1601; origin 17; probe rigid body 18; ball and socket calibration fixture 200; concave surface 20; measured rigid object 300; positioning point 30; world coordinate system A; body coordinate system B; measurement coordinate system C; motion capture system D. DETAILED DESCRIPTION
[0030] Embodiments of the present invention are described in detail below, examples of which are shown in the accompanying drawings, wherein the same or similar reference numerals throughout represent the same or similar elements or elements having the same or similar functions. The embodiments described below with reference to the accompanying drawings are exemplary and are only used to explain the present invention, and cannot be understood as limiting the present invention.
[0031] Combine the following Figures 1 to 5 The coordinate system precise registration device and method of the motion capture system according to the embodiment of the present invention are described.
[0032] like Figure 1 and Figure 2 As shown, the coordinate system precise registration device of the motion capture system of the first aspect of the embodiment of the present invention is a T-shaped probe 100, which is used for the coordinate system precise registration of the motion capture system D.
[0033] Specifically, the T-type probe 100 includes a plate 10 and a probe 15; wherein the plate 10 can be handheld, and an infrared emitting module 11 (also called a target point) is provided on one side of the plate 10, and the infrared emitting module 11 is used to emit infrared rays so that the motion capture system D can recognize them; the infrared emitting module 11 has at least three ( Figure 1 In the figure, six infrared emitting modules 11 are shown and are asymmetrically distributed, such as staggered distribution. The at least three infrared emitting modules 11 are not distributed on one side of the plate 10, which is conducive to the motion capture system D being able to identify the at least three infrared emitting modules 11 on the plate 10, and can avoid the motion capture system D from establishing an erroneous probe rigid body 18 for the at least three infrared emitting modules 11 (such as Figure 3As shown in FIG. 1 , the space of the plate 10 can be fully utilized. One end of the probe 15 is fixed to the plate 10. In this way, the plate 10 is supported by a probe 15. For larger rigid objects 300 to be measured, such as aircraft parts, the plate 10 can be flexibly changed on some larger rigid objects 300 to be measured, avoiding interference between the plate 10 and the rigid objects 300 to be measured, so that the T-shaped probe 100 can fully utilize the space. The other end of the probe 15 is fixed with a rigid ball 16, as shown in FIG. Figure 4 and Figure 5 As shown, the rigid ball 16 is used to be placed on the ball-and-socket calibration fixture 200 and to prevent it from being on the rigid object 300 to be measured, so as to facilitate the T-type probe 100 to change its posture and keep the center position of the rigid ball 16 unchanged.
[0034] When the coordinate system precise registration device of the motion capture system of the first embodiment of the present invention is used for registration, the T-shaped probe 100 itself has a certain processing error, so it needs to be calibrated. In the calibration process: Figure 3 As shown, firstly, a T-shaped probe coordinate system is established, and a probe rigid body 18 is established for the target points of at least three infrared emitting modules 11 in the motion capture system D, and the target point of one of the infrared emitting modules 11 is taken as the origin 17; Figure 4 As shown, the rigid ball 16 of the T-type probe 100 is then placed in the concave surface 20 of the socket calibration fixture 200, the position of the rigid ball 16 is kept fixed, the posture of the T-type probe 100 is changed, and the posture of at least four groups of T-type probe coordinate systems are measured by the motion capture system D; then, the least squares method is used to perform spherical fitting on the origin 17 of the at least four groups of T-type probes 100 with different postures measured, and the precise position of the center 1601 of the rigid ball 16 in the T-type probe coordinate system is obtained; in the matching link: as Figure 5 As shown, the rigid ball of the T-type probe 100 is placed at the positioning point 30 of the rigid object 300 to be measured, and the coordinates of the positioning point 30 are calculated from the posture of the T-type probe 100 and the calibration result; the coordinates of at least three positioning points 30 on the rigid object 300 to be measured are matched with the coordinates of the positioning points 30 in the coordinate system of the three-dimensional physical model of the rigid object 300 to be measured by ICP point cloud matching, and the optimal transformation matrix is calculated, so as to complete the high-precision registration of the measurement coordinate system C of the rigid object 300 to be measured in the motion capture system D and the body coordinate system B in its three-dimensional physical model, and its accuracy can reach the sub-millimeter level. At this time, the precise position of any point of the rigid object 300 to be measured can be indirectly measured according to the three-dimensional physical model, and the sub-millimeter accuracy of the motion capture system D itself can be achieved. This greatly reduces the centimeter-level error caused by factors such as the radius of the target ball and the manual pasting method in the prior art, expands the application scope of the motion capture system D, and can meet the needs of more complex tasks.
[0035] According to the first aspect of the present invention, the precise registration device of the coordinate system of the motion capture system has the following advantages: the special T-type probe 100 is calibrated by using the ball-and-socket calibration tool 200 and the spherical fitting method, so that the motion capture system D can measure the precise position of the surface positioning point 30 (including the obscured point) of the rigid object; the measurement value of the positioning point 30 is matched with the three-dimensional physical model by the ICP algorithm, and finally the precise conversion relationship between the measurement coordinate system and the object body coordinate system B is obtained, and its accuracy can reach the sub-millimeter level, so as to realize the high-precision registration of the measurement coordinate system C in the motion capture system D with the body coordinate system B in its three-dimensional physical model, so as to indirectly measure the precise position of any point of the corresponding three-dimensional physical model, which is helpful to promote the application of the motion capture system D in many fields such as intelligent assembly, processing, motion simulation, digital twin, etc. In addition, the asymmetric distribution structure of the target point of the T-type probe 100 effectively avoids system misidentification and makes full use of the space of the plate 10, and the structure of the T-type probe 100 also enables it to measure the obscured positioning point 30. Furthermore, the calibration method based on spherical fitting and the point cloud matching method based on ICP effectively reduce the impact of measurement errors on the registration results.
[0036] In some embodiments, the plate 10 is a composite plate, that is, the plate 10 is made of composite material. It is understandable that, because the plate 10 needs to be larger when measuring a larger rigid object 300 such as an aircraft component, the plate 10 is made of composite material, and the plate 10 is light in weight, so it is convenient to move the T-type probe 100 during measurement.
[0037] In some embodiments, the probe 15 is a stainless steel probe 15 . The stainless steel probe 15 has good strength, can support the plate 10 and is not easily deformed.
[0038] In some embodiments, a power supply module 14 and a switch are provided on the other side of the plate 10. The power supply module 14 is used to supply power to the infrared emitting module 11, and the switch is used to control the power on or off of the infrared emitting module 11. In this way, the T-type probe 100 is easy to use.
[0039] In some embodiments, a hand-held portion 13 is provided on the plate 10 to facilitate the operation of the T-shaped probe 100, so that the T-shaped probe 100 can be changed into different positions or moved during registration.
[0040] In some embodiments, the hand-held portion 13 is a through hole provided on the plate 10. This facilitates the operation of the T-shaped probe 100, enables the T-shaped probe 100 to change different positions or be conveniently moved during registration, and the hand-held portion 13 has a simple structure.
[0041] In some embodiments, there are six infrared emitting modules 11, wherein among the six infrared emitting modules 11, some infrared emitting modules 11 are fixed on the plate 10 through the base 12, and some infrared emitting modules 11 are directly fixed on the plate 10. For example, Figure 1 As shown, the infrared emitting modules 11 are arranged asymmetrically on the plate 10 in a staggered manner, wherein two infrared emitting modules 11 do not have a base 12 and are directly fixed on the plate 10, and the remaining four infrared emitting modules 11 are fixed on the plate 10 by bases 12, two bases 12 are 20 mm high, and the other two bases 12 are 50 mm high. On the one hand, this staggered distribution method helps to make full use of the space of the plate 10 so that it can be recognized in more postures, and on the other hand, it avoids the symmetrical structure causing the motion capture system D to recognize the wrong rigid body. The wavelength of infrared light emitted by the infrared emitting module 11 is consistent with the acquisition wavelength of the motion capture camera.
[0042] In some embodiments, the rigid ball 16 is a steel ball, and the radius may be 1.5 to 3 mm, preferably 2 mm.
[0043] A second aspect of the present invention proposes a method for accurate registration of coordinates of a motion capture system D.
[0044] According to the coordinate system precise registration method of the motion capture system D of the second embodiment of the present invention, the coordinate system precise registration device of the motion capture system of the first embodiment of the present invention is used for registration, and the method comprises the following steps:
[0045] Calibration stage: Figure 3 As shown, first, a coordinate system of a T-type probe is established, and a probe rigid body 18 is established for at least three infrared transmitting modules 11 in a motion capture system D, with one of the infrared transmitting modules 11 as the origin 17; then, the rigid ball 16 of the T-type probe 100 is placed in the concave surface 20 of the calibration tooling, the position of the rigid ball 16 is kept fixed, the posture of the T-type probe 100 is changed, and the posture of at least four groups of T-type probe coordinate systems are measured by the motion capture system D; then, a spherical fitting is performed on the origin 17 of at least four groups of T-type probes 100 with different postures measured by the least squares method to obtain the precise position of the center 1601 of the rigid ball 16 in the T-type probe coordinate system.
[0046] Matching step: place the rigid ball 16 of the T-type probe 100 at the positioning point 30 of the rigid object 300 to be measured, and calculate the coordinates of the positioning point 30 from the posture of the T-type probe 100 and the calibration result; perform ICP point cloud matching on the coordinates of at least three positioning points 30 and the coordinates of the positioning point 30 in the three-dimensional physical model of the rigid object 300 to obtain the optimal transformation matrix, thereby completing the precise alignment of the coordinate system.
[0047] The following describes in detail the coordinate system precise registration method of the motion capture system D.
[0048] In the calibration phase, Figure 3 As shown, first establish the coordinate system of the T-type probe 100, turn on the targets of the six infrared emission modules 11 in the measurement field D of the motion capture system, take the farthest target as the origin 17 in the software, and establish the six targets as a probe rigid body. The distance from the origin 17 to the rigid ball 16 is far, which is conducive to improving the spherical fitting accuracy. Then, place the rigid ball 16 of the T-type probe 100 at the center of the ball socket calibration fixture 200, tangent to the fixture surface, and hold the panel 10 and rotate it while keeping the rigid ball 16 fixed, and measure its posture matrix T in different (more than four) postures. pi (i=1,2...). The concave surface 20 in the middle of the ball socket calibration fixture 200 is conical, and high processing accuracy must be ensured. The calibration fixture of products such as laser trackers can be used. Theoretically, the origin 17 of the T-type probe coordinate system is distributed on the spherical surface of the center 1601 of the rigid ball 16, but the actual error causes the measurement results to be distributed near the spherical surface. Therefore, the spherical fitting algorithm in the sense of least squares is used to calculate the coordinates of the center 1601. Assume that the measurement value of the origin 17 of the T-type probe coordinate system is (x pi ,y pi ,z pi ), the coordinates of the sphere center 1601 are (x0, y0, z0), the radius of the sphere is r, and the cost function in the sense of least squares is constructed Calculate the coordinates of the sphere center 1601 and the radius when the cost function takes the minimum value. This spherical fitting method has mature theory and algorithm, and can be directly called in languages such as Python. The calibration operation process is similar to the spherical fitting process. Figure 4 Finally, the coordinates of the sphere center 1601 are substituted into the T-type probe coordinate system, and the average is taken to eliminate the measurement error, and the calibration result is obtained, that is, the position of the sphere center 1601 of the rigid ball 16 in the T-type probe coordinate system:
[0049]
[0050] This calibration method can effectively eliminate the influence of the measurement error of the motion capture system D. It should be noted that since the deformation of the T-type probe 100 itself affected by factors such as room temperature can be ignored, a T-type probe 100 generally only needs to be calibrated once.
[0051] In the matching process, Figure 5As shown, the rigid object 300 to be measured and the motion capture system D are prepared, and the world coordinate system of the motion capture system D is set as A, and the body coordinate system corresponding to the three-dimensional physical model of the rigid object to be measured is set as B. The T-type probe 100 is arranged on the surface of the rigid object 300 to be measured, and the rigid body and measurement coordinate system C are established in the software, and its posture measurement value is expressed as T i (i=1, 2, ...). In addition, n positioning points 30 (at least three, the more the number, the larger the distribution range and the smaller the error) marked on the rigid object 300 to be measured are selected, and the rigid beads 13 of the T-type probe 100 are placed on the positioning points 30 in sequence to obtain the T-type probe 100 posture data T pi (i=1,2...n), multiply the calibration result on the right to get the coordinates of the positioning point 30 Then convert it into coordinates under coordinate system C Since the reference system is not the world coordinate system A, the superscript C indicates that the reference system of the variable is the coordinate system C, and the same applies below. Because the probe 15 has a certain length, some obscured positioning points 30 can also be measured. At the same time, the coordinates of these positioning points 30 in the model body coordinate system B are obtained in the three-dimensional physical model of the rigid object being measured. Finally, the ICP matching method is used to find the optimal transformation matrix Make the cost function Take the minimum value, which can eliminate the influence of measurement error on registration accuracy. The ICP matching method has mature theory and algorithm, which can be directly called in Python and other languages. So far, the precise registration of the coordinate system under the motion capture system D has been completed. If you need to obtain the coordinates (x key ,y key ,z key ), we only need to multiply the model coordinates by the measured pose of the object after registration That's it, It should be noted that the registration step needs to be performed each time the measurement target sphere of the object is changed, because this changes the pose transformation between coordinate system B and coordinate system C. Figure 3 The operation of the registration link and the ICP matching process are demonstrated.
[0052] This registration method is essentially a virtual-real mapping, that is, the coordinate system of the digital 3D physical model corresponds to the actual object, and the transformation matrix relative to the measurement system is calculated. Through this method, under the premise of the accuracy of the 3D physical model, the precise position of any point on the object can be indirectly measured, making the motion capture system D suitable for more intelligent application scenarios.
[0053] According to the method for accurate registration of the coordinate system of the motion capture system D of the second embodiment of the present invention, it has the following advantages: the special T-type probe 100 is calibrated by using the ball-and-socket calibration fixture 200 and the spherical fitting method, so that the motion capture system D can measure the precise position of the surface positioning point 30 (including the obscured point) of the rigid object; then the measurement value of the positioning point 30 is matched with the three-dimensional physical model by the ICP algorithm, and finally the precise conversion relationship between the measurement coordinate system and the object body coordinate system B is obtained, and its accuracy can reach the sub-millimeter level, so as to realize the high-precision registration of the measurement coordinate system C in the motion capture system D with the body coordinate system B in its three-dimensional physical model, so as to indirectly measure the precise position of any point of the corresponding three-dimensional physical model, which is helpful to promote the application of the motion capture system D in many fields such as intelligent assembly, processing, motion simulation, digital twin, etc. In addition, the asymmetric distribution structure of the target point of the T-type probe 100 effectively avoids system misidentification and makes full use of the space of the plate 10, and the structure of the T-type probe 100 also enables it to measure the obscured positioning point 30. Furthermore, the calibration method based on spherical fitting and the point cloud matching method based on ICP effectively reduce the impact of measurement errors on the registration results.
[0054] In some embodiments, Figure 4 As shown, the concave surface 20 of the calibration fixture is a conical surface, which is beneficial for keeping the position of the rigid ball 16 fixed when the T-shaped probe 100 changes its position.
[0055] In some embodiments, during the calibration phase, such as Figure 3 As shown, taking an infrared light target point farthest from the center 1601 of the rigid ball 16 as the origin 17 is beneficial to improving the spherical fitting accuracy.
[0056] In the description of this specification, the description with reference to the terms "one embodiment", "some embodiments", "illustrative embodiments", "examples", "specific examples", or "some examples" means that the specific features, structures, or characteristics described in conjunction with the embodiment or example are included in at least one embodiment or example of the present invention. In this specification, the schematic representation of the above terms does not necessarily refer to the same embodiment or example. Moreover, the specific features, structures, or characteristics described may be combined in any one or more embodiments or examples in a suitable manner.
[0057] Although the embodiments of the present invention have been shown and described, it will be appreciated by those skilled in the art that various changes, modifications, substitutions and variations may be made to the embodiments without departing from the principles and spirit of the present invention, and that the scope of the present invention is defined by the claims and their equivalents.
Claims
1. A coordinate system accurate registration device for a motion capture system, characterized in that: The coordinate system precise registration device of the motion capture system is a T-shaped probe, comprising: A plate, one side of which is provided with infrared emitting modules, wherein there are at least three infrared emitting modules which are asymmetrically distributed; A probe, one end of which is fixed to the plate, and the other end of which is fixed with a rigid ball.
2. The coordinate system precise registration device of the motion capture system according to claim 1, characterized in that: The plate is a composite material plate.
3. The coordinate system precise registration device of the motion capture system according to claim 1, characterized in that: The probe is a stainless steel probe.
4. The coordinate system precise registration device for the motion capture system according to claim 1, characterized in that: A power supply module is provided on the other side of the plate, and the power supply module is used to supply power to the infrared emitting module.
5. The coordinate system precise registration device of the motion capture system according to claim 1, characterized in that: A hand-holding portion is provided on the plate.
6. The coordinate system precise registration device for the motion capture system according to claim 5, characterized in that: The hand-held portion is a through hole arranged on the plate.
7. The coordinate system precise registration device of the motion capture system according to claim 1, characterized in that: There are six infrared emitting modules, wherein among the six infrared emitting modules, some of the infrared emitting modules are fixed on the plate through a base, and some of the infrared emitting modules are directly fixed on the plate.
8. A method for accurate registration of coordinates of a motion capture system, characterized in that: The coordinate system precise registration device of the motion capture system according to any one of claims 1 to 7 is used for registration, comprising the following steps: Calibration step: firstly, establish the coordinate system of the T-type probe, establish a probe rigid body for at least three of the infrared light emitting modules in the motion capture system, and take one of the infrared light emitting modules as the origin; then place the rigid ball of the T-type probe in the concave surface of the ball socket calibration tooling, keep the position of the rigid ball unchanged, change the posture of the T-type probe, and use the motion capture system to measure at least four groups of postures of the T-type probe coordinate system; then use the least squares method to perform spherical fitting on the origin of at least four groups of T-type probes with different postures, and obtain the precise position of the center of the rigid ball in the T-type probe coordinate system; Matching step: place the rigid ball of the T-type probe at the positioning point of the rigid object to be measured, and calculate the coordinates of the positioning point based on the posture of the T-type probe and the calibration result; perform ICP point cloud matching on the coordinates of at least three positioning points and the coordinates of the positioning points in the three-dimensional physical model of the rigid object to be measured, and calculate the optimal transformation matrix, thereby completing the precise alignment of the coordinate system.
9. The method for accurate coordinate registration of a motion capture system according to claim 8, characterized in that: The concave surface of the calibration tool is a conical surface.
10. The method for accurate coordinate registration of a motion capture system according to claim 8, characterized in that: In the calibration step, the infrared light target point farthest from the center of the rigid ball is taken as the origin.
