Positioning method of six-degree-of-freedom motion platform control center

Through the cooperation of the laser tracker and the T-MAC probe, the control center and world coordinate system position of the six-degree of freedom motion platform is determined using the best fit method, which solves the problem of low positioning accuracy in the existing technology and achieves high accuracy Dynamic calibration and motion accuracy improvement.

CN119065236AActive Publication Date: 2024-12-03ZHEJIANG FINANCIAL COLLEGE
View PDF 4 Cites 0 Cited by

Patent Information

Application Number
CN202411028013.X
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-30
Publication Date
2024-12-03
Estimated Expiration
2044-07-30

AI Technical Summary

Technical Problem

The existing six-degree-of-freedom motion platform measurement and calibration methods are mainly aimed at a single posture or displacement, and cannot accurately reflect the platform performance under composite motion, resulting in low positioning accuracy of the control center, affecting the motion accuracy and application effect.

Method used

The uniformly distributed motion posture of the six-degree-of-freedom motion platform is measured by using laser tracker and T-MAC probe. The control center position and the position deviation of the world coordinate system are determined through best fitting. The measurement software and control software are adjusted to improve positioning. Accuracy.

Benefits of technology

The accuracy of the control center positioning of the six-degree-of-freedom motion platform is significantly improved, the dynamic calibration of the platform is realized, the measurement error is reduced, and the motion accuracy and application effect are improved.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119065236A_ABST
    Figure CN119065236A_ABST
Patent Text Reader

Abstract

The invention discloses a positioning method for a control center of a six-degree-of-freedom motion platform, and the method comprises the steps: correcting the position error of a control center bound with a sensor and a real control center, and the error of a world coordinate system of the six-degree-of-freedom motion platform and a world coordinate system of a laser tracker; the precision of searching a world coordinate system and an actual control center can be improved, a measurement model is constructed by combining a laser tracker, T-MAC and other hardware equipment, and calibration of the six-degree-of-freedom motion platform can be well completed. After the measurement error is corrected and eliminated, a real-time platform control value is provided when the platform is in a motion state, a measurement value is obtained in real time through relatively fixed T-MAC hardware equipment, and real-time dynamic calibration can be completed by comparing the real-time platform control value with the measurement value. The method is high in precision and high in efficiency, and can be widely applied to a six-degree-of-freedom motion platform.
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present invention relates to the technical field of a six-degree-of-freedom motion platform, in particular to the technical field of a positioning method for a control center of a six-degree-of-freedom motion platform. [Background technology]

[0002] The motion control accuracy of the six-degree-of-freedom motion platform directly affects the simulation effect of its built environment, from scientific research experiments, engineering construction, technology development to the immersive effect of virtual reality. Therefore, it is urgent to study scientific and effective methods to measure and calibrate the characteristic parameters of the six-degree-of-freedom motion platform to verify whether the actual simulation environment meets the target requirements of production and development. At present, the measurement and calibration methods of the six-degree-of-freedom motion platform are mostly technical specifications for partial testing of a single posture or displacement, and there is no complete and systematic method for the calibration of the compound motion of the posture, especially the calibration of the dynamic characteristics of the compound motion.

[0003] The existing measurement work of the six-degree-of-freedom motion platform generally starts from the independent measurement of the displacement of a single coordinate axis or the angle of rotation in a single direction (hereinafter summarized as "single degree of freedom"), which is actually not in line with the reality of the six-degree-of-freedom motion platform. The measurement of the six-degree-of-freedom compound motion of the platform is in line with the measurement logic. The independent measurement method of a single degree of freedom can only reflect the accuracy of the six-degree-of-freedom motion platform for the displacement or rotation of a single coordinate axis. This means that when the platform is performing single-degree-of-freedom motion, accurate measurement results can be obtained regardless of the position of the measurement target on the platform. However, the six-degree-of-freedom motion platform is actually performing a compound motion of six degrees of freedom. In this motion mode, because the motion instructions sent by the six-degree-of-freedom platform are only for the control center, there is only a description of the position and posture of the control center of the six-degree-of-freedom motion platform. 6d控制中心 (x, y, z, rx, ry, rz) can represent the motion position and posture information of the six-degree-of-freedom platform, and other measurement points on the platform cannot represent it. Therefore, the original single-degree-of-freedom independent measurement method obviously cannot accurately reflect the platform performance of the six-degree-of-freedom motion platform under compound motion, and it is a local and one-sided measurement method. Therefore, if you want to accurately measure the position and posture of the six-degree-of-freedom motion platform, the key is to find the control center of the six-degree-of-freedom motion platform.

[0004] In the actual working process, the control center of the six-degree-of-freedom motion platform can also be roughly determined using traditional methods. In general, the six-degree-of-freedom motion platform itself will not give the reference of its world coordinate system, so it is necessary to find the world coordinate system and actual control center of the six-degree-of-freedom motion platform by measuring the various motion states of the six-degree-of-freedom motion platform. The traditional method can reset the six-degree-of-freedom motion platform to zero, fix a target at any non-control center position of the six-degree-of-freedom motion platform, control the six-degree-of-freedom motion platform to move along the Z axis to determine the Z axis direction, move along the X axis to determine the X axis direction, and finally control the six-degree-of-freedom motion platform to rotate around the control center to determine the control center position, so as to determine the world coordinate system and control center position of the six-degree-of-freedom motion platform. Among them, the coordinate system position of the control center of the six-degree-of-freedom motion platform in the initial position state is the world coordinate system position during the test.

[0005] However, the traditional method of finding the control center of the six-degree-of-freedom motion platform will introduce multiple large errors in actual operation. The repeatability of the world coordinate system of the six-degree-of-freedom motion platform established by the traditional method is very dependent on the accuracy of the six-degree-of-freedom motion platform itself. Because the six-degree-of-freedom motion platform is often used in large-scale projects, hydraulic control is usually adopted, and its own control accuracy is not too high. In addition, due to the design and structural factors of the six-degree-of-freedom motion platform itself, the rotation angle is small in some degrees of freedom (such as the conventional six-degree-of-freedom motion platform around the Z axis The rotation angle range is very small, and the small angle rotation amount has a large error in finding the center of the circle), which will also have a great impact on the positioning accuracy of its control center. Therefore, this traditional method has the possibility of finding the world coordinate system and control center of the six-degree-of-freedom motion platform in theory, but it will introduce multiple large errors in actual operation. For example, when controlling the six-degree-of-freedom motion platform to rotate around a certain axis, the coordinate values ​​of the other two axes of the control center can be generated. When rotating around three coordinate axes respectively, 6 coordinate values ​​will be generated, and three of the coordinate values ​​are repeated. Often, due to the low accuracy of the measured equipment, the deviation between these repeated coordinate values ​​is large. Alternatively, when controlling the six-degree-of-freedom motion platform to move along the X, Y, and Z axes, the three axes are not perpendicular to each other, which will also cause errors in the construction of the coordinate system. Ultimately, these errors will be reflected in two errors, namely the position error between the control center bound to the sensor and the actual control center, and the error between the world coordinate system of the six-degree-of-freedom motion platform and the world coordinate system of the laser tracker. Therefore, this traditional method can only be used as a way to roughly locate the six-degree-of-freedom world coordinate system and the control center. Traditional methods cannot locate the control center of the six-degree-of-freedom motion platform more accurately, and cannot guide manufacturers to adjust the control center to a more intuitive and accurate initial position on the platform, resulting in a decrease in the actual control accuracy of the six-degree-of-freedom motion platform, and failing to meet the design accuracy requirements.

[0006] The current main applications of the six-degree-of-freedom motion platform are in environmental simulation, steady-state environment construction and large-scale workpiece splicing. In view of these uses and the characteristics of the six-degree-of-freedom motion platform itself, it is very important to determine the world coordinate system measurement and actual control center of the six-degree-of-freedom motion platform. This is not only conducive to the calibration of the platform and improving the platform's motion accuracy, but also provides a guarantee for the platform's application in actual scenarios and better application expansion space.

[0007] In order to better explain the technical solution, the following terms are explained as follows:

[0008] 1. Six degrees of freedom motion - Six degrees of freedom motion is divided into three translation position motions and three rotation posture motions. Especially in the posture rotation, the rotation method and rotation order are not unique. All the position and posture motions described in this article are first rotated around the X-axis, Y-axis, and Z-axis of the world coordinate system in the order of (Δrx, Δry, Δrz), and then undergo a displacement of (dx, dy, dz);

[0009] 2. Six-degree-of-freedom point - It is a measured coordinate system bound to the six-degree-of-freedom motion platform, which represents a position and posture state of the six-degree-of-freedom motion platform. It means that the object starts from the origin, rotates in the order of (Δrx, Δry, Δrz), and then undergoes a displacement of (dx, dy, dz). The final position and posture can be expressed by P 6d (x, y, z, rx, ry, rz) is called a six-degree-of-freedom point;

[0010] 3. Control center six degrees of freedom point P 6d控制中心 (x, y, z, rx, ry, rz)——A measured coordinate system is bound to the six-degree-of-freedom motion platform, and the origin of the measured coordinate system is the control center. 6d控制中心 The first three parameters (x, y, z, rx, ry, rz) are position coordinates, which actually describe the position of the control center. 6d控制中心 The last three parameters (rx, ry, rz) of (x, y, z, rx, ry, rz) reflect the posture of the six-degree-of-freedom motion platform by describing the current posture of the control center;

[0011] 4. Matrix formula of six-degree-of-freedom motion and six-degree-of-freedom point - In order to facilitate the unification of calculations, six-degree-of-freedom motion and six-degree-of-freedom points are expressed in matrix form;

[0012] 5. Origin P 6d The matrix form of (0,0,0,0,0,0) - the matrix at the origin is the identity matrix

[0013] 6. Six-degree-of-freedom translation matrix——

[0014] 7. Six-degree-of-freedom rotation matrix——

[0015] Rotate Δrz around the Z axis

[0016]

[0017] Rotate Δry around the Y axis

[0018]

[0019] Rotate Δrx around the X axis

[0020] [Summary of the invention]

[0021] The purpose of the present invention is to solve the problems in the prior art and to propose a positioning method for the control center of a six-degree-of-freedom motion platform, which can improve the accuracy of world coordinate system measurement and control center search of the six-degree-of-freedom motion platform and realize dynamic calibration of the six-degree-of-freedom motion platform.

[0022] To achieve the above object, the present invention proposes a positioning method for a control center of a six-degree-of-freedom motion platform, comprising the following steps:

[0023] S1. Use traditional methods to roughly locate the initial position of the world coordinate system and control center of the six-degree-of-freedom motion platform;

[0024] S2, using laser tracker and T-MAC probe to measure a large number of motion poses evenly distributed within the travel range of the six-degree-of-freedom motion platform;

[0025] S3, according to the measurement model of the six-degree-of-freedom motion platform, using the motion posture in step S2 as a parameter, obtaining the six-degree-of-freedom motion platform control center position deviation and the world coordinate system position deviation through optimal fitting;

[0026] S4, using the two deviations obtained by fitting in step S3, respectively adjusting the control center position of the six-degree-of-freedom motion platform and the world coordinate system position in the laser tracker measurement software;

[0027] S5. The position and posture of the six-degree-of-freedom motion platform are directly measured by the T-MAC probe.

[0028] Preferably, in step S1, a round of rough positioning of the control center and the world coordinate system of the six-degree-of-freedom motion platform is performed by traditional methods: the pin hole at the center position of the surface of the six-degree-of-freedom motion platform is used as the control center of the six-degree-of-freedom motion platform, the control center position when the six-degree-of-freedom motion platform is in a zero state is used as the origin of the measurement coordinate system, and the three coordinate axis directions of the six-degree-of-freedom motion platform are used as the directions of the three axes of the measurement coordinate system.

[0029] Preferably, in step S2: based on the rough positioning in step S1, a group of i-point motion control instructions P are sent to the six-degree-of-freedom motion platform. 6d平台i (x 平台i ,y 平台i ,z 平台i ,rx 平台i ,ry 平台i ,rz 平台i ), and obtain a set of corresponding tracker values ​​P at i points 6d跟踪仪i (x 跟踪仪i ,y 跟踪仪i ,z 跟踪仪i ,rx 跟踪仪i ,ry 跟踪仪i ,rz 跟踪仪i ), and this set of measured values ​​is used as the best fitting parameters in step S3.

[0030] Preferably, in step S3, P 6d The matrix form of the six-degree-of-freedom point (x, y, z, rx, ry, rz) is:

[0031] 6Dmartix=Trans(x,y,z)×Rotz(rz)×Roty(ry)×Rotx(rx)×I (1)

[0032] Substituting the i-group parameters obtained in step S2 into formula (1), we get the following objective function formula (2):

[0033]

[0034] Where, 6Dmartix 六自由度平台控制值i and 6Dmartix 激光跟踪仪测量值i is to set P 6d平台i (x 平台i ,y 平台i ,z 平台i ,rx 平台i ,ry 平台i ,rz 平台i ) and P 6d跟踪仪i (x 跟踪仪i ,y 跟踪仪i ,z 跟踪仪i ,rx 跟踪仪i ,ry 跟踪仪i ,rz 跟踪仪i ) is substituted into the matrix form calculated by formula (1);

[0035] At the same time, the matrix part of formula (1) is expanded and listed, where 6Dmartix[ij] is the i-th row and j-th column of the 6Dmartix matrix:

[0036]

[0037] Formula (3) can be further deduced to obtain formula (4):

[0038] rx=arctan(6Dmartix[3 2] / 6Dmartix[3 3])

[0039]

[0040] rz=arctan(6Dmartix

[21] / 6Dmartix

[11] )

[0041] x = 6Dmartix

[14]

[0042] y=6Dmartix

[24]

[0043] z=6Dmartix

[34] (4)

[0044] 6Dmartix 激光跟踪仪测量值i Substituting into formula (2) and formula (4), we get B i The function of X is shown in formula (5):

[0045]

[0046] Where X=[Δrz1Δry1Δrx1 dx1 dy1 dz1 dx2 dy2 dz2Δrz2Δry2Δrx2] T Then, when there are n measurement points, the system of equations can be combined to obtain formula (6):

[0047]

[0048] Where Y=[Y1Y2…Y n ] T , is the motion control position obtained by sending n motion control instructions to the six-degree-of-freedom motion platform, Y i =[x 平台i y 平台i z 平台i rz 平台i ry 平台i rx 平台i ] T F(X) is B i The simultaneous equations of ;

[0049] Let the zero matrix be X = [Δrz1Δry1Δrx1 dx1 dy1 dz1 dx2 dy2 dz2Δrz2Δry2Δrx2] T The initial value of is iterated according to formula (9),

[0050] X k+1 =X k -(J T J) -1 [J T (F(X k )-Y)] (9)

[0051] Where J is Y=F(X k )’s Jacobian matrix, and the Newton downhill method is used to iterate the sum of squares of the errors on both sides of equation (9) to minimize the best fitting values ​​of X, i.e., (dx1, dy1, dz1, Δrx1, Δry1, Δrz1) and (dx2, dy2, dz2, Δrx2, Δry2, Δrz2).

[0052] Preferably, in step S4, (dx1, dy1, dz1, Δrx1, Δry1, Δrz1) obtained in step S3 is used to adjust the posture of the world coordinate system in the tracker measurement software; (dx2, dy2, dz2, Δrx2, Δry2, Δrz2) is used for the control software of the six-degree-of-freedom motion platform to adjust the posture of the control center of the six-degree-of-freedom motion platform.

[0053] Beneficial effects of the present invention: The present invention can improve the accuracy of finding the world coordinate system and the actual control center by correcting the two major errors: the position error of the control center bound to the sensor and the real control center, and the error between the world coordinate system of the six-degree-of-freedom motion platform and the world coordinate system of the laser tracker. By combining the laser tracker and hardware devices such as T-MAC, a measurement model is constructed, and the calibration of the six-degree-of-freedom motion platform can be completed well. After the measurement error is corrected and eliminated, the platform provides a real-time platform control value in a moving state, and the measurement value is obtained in real time through the relatively fixed T-MAC hardware device. The real-time dynamic calibration can be completed by comparing the two. The method has high accuracy and efficiency and can be widely applied to six-degree-of-freedom motion platforms.

[0054] The features and advantages of the present invention will be described in detail through embodiments in conjunction with the accompanying drawings.

Brief Description of the Drawings

[0055] Figure 1 It is a measurement model diagram of a six-degree-of-freedom motion platform according to a positioning method of a control center of a six-degree-of-freedom motion platform of the present invention. [Specific implementation method]

[0056] This scheme proposes the best fitting method to determine the world coordinate system and actual control center of the six-degree-of-freedom motion platform. A laser tracker and T-MAC are used to measure a large number of motion postures evenly distributed within the travel range of the six-degree-of-freedom motion platform. Based on the measurement model of the six-degree-of-freedom motion platform, the best fitting method is used to solve the control center and world coordinate system position of the six-degree-of-freedom motion platform.

[0057] The measurement error model is analyzed as follows:

[0058] like Figure 1 As shown in Figure 1, the measurement model describes the correction model of two larger errors introduced in the traditional method (the position error between the sensor-bound control center and the real control center, and the error between the world coordinate system of the six-degree-of-freedom motion platform and the world coordinate system of the laser tracker), in which the error between the world coordinate system of the six-degree-of-freedom motion platform and the world coordinate system of the laser tracker is compensated by six-degree-of-freedom motion (dx1, dy1, dz1, Δrx1, Δry1, Δrz1), and the position error between the sensor-bound control center and the real control center is compensated by six-degree-of-freedom motion (dx2, dy2, dz2, Δrx2, Δry2, Δrz2).

[0059] (dx1, dy1, dz1, Δrx1, Δry1, Δrz1) and (dx2, dy2, dz2, Δrx2, Δry2, Δrz2) can be solved by software using this mathematical model and the actual measured data of the tracker.

[0060] The specific method is:

[0061] The first step is to perform a round of rough positioning of the control center and world coordinate system of the six-degree-of-freedom motion platform according to the traditional method introduced in the previous article: the pin hole at the center of the surface of the six-degree-of-freedom motion platform is used as the origin of the world coordinate system of the tracker, the Z+ axis movement direction of the six-degree-of-freedom motion platform is used as the main axis of the coordinate axis Z+ direction, and the X+ axis movement direction of the six-degree-of-freedom motion platform is used as the secondary axis of the world coordinate system X+ direction. The world coordinate system is established by determining the Y+ direction through the Z+ and X+ directions and the right-hand screw rule; when the six-degree-of-freedom motion platform is in zero position, its control center coordinate system coincides with the world coordinate system, that is, T-MAC is used to bind the world coordinate system in the zero position state, and when the posture of the six-degree-of-freedom platform changes subsequently, T-MAC can continuously track the posture of its control center;

[0062] The second step is to send a set of i-point motion control instructions P to the six-degree-of-freedom motion platform. 6d平台i (x 平台i ,y 平台i ,z 平台i ,rx 平台i ,ry 平台i ,rz平台i ), and measure a set of i points with corresponding tracker values ​​P 6d跟踪仪i (x 跟踪仪i ,y 跟踪仪i ,z 跟踪仪i ,rx 跟踪仪i ,ry 跟踪仪i ,rz 跟踪仪i ), this set of measured values ​​will be used as the best fitting parameters in step S3;

[0063] Let X = [δ1δ2…δ 12 ] T =[Δrz1Δry1Δrx1 dx1 dy1 dz1 dx2 dy2 dz2Δrz2Δry2Δrx2] T , the motion control instruction of the i-th point is Y i =[x 平台i y 平台i z 平台i rz 平台i ry 平台i rx 平台i ] T , the corresponding measured value of the tracker at the i-th point is: A i =[x 跟踪仪i y 跟踪仪i z 跟踪仪i rz 跟踪仪i ry 跟踪仪i rx 跟踪仪i ] T ;

[0064] Step 3, P 6d The matrix formula of the six-degree-of-freedom point (x, y, z, rx, ry, rz) is:

[0065] 6Dmartix=Trans(x,y,z)×Rotz(rz)×Roty(ry)×Rotx(rx)×I (1)

[0066] Expand formula (1) to:

[0067]

[0068]

[0069] The measurement error model formula is as follows:

[0070]

[0071] A i Substituting into formula (8), we can get 6Dmartix 激光跟踪仪测量值i, and then 6Dmartix 激光跟踪仪测量值i Substituting into formula (2), we can get 6Dmartix 六自由度平台控制值i ;

[0072] At the same time, the matrix part of formula (1) is expanded and listed, where 6Dmartix[ij] is the i-th row and j-th column of the 6Dmartix matrix:

[0073]

[0074] Formula (3) can be further deduced to obtain formula (4):

[0075] rx=arctan(6Dmartix

[32] / 6Dmartix[3 3])

[0076]

[0077] rz=arctan(6Dmartix

[21] / 6Dmartix

[11] )

[0078] x = 6Dmartix

[14]

[0079] y=6Dmartix

[24]

[0080] z=6Dmartix

[34] (4)

[0081] The i-th group of laser tracker data A i =[x 跟踪仪i y 跟踪仪i z 跟踪仪i rz 跟踪仪i ry 跟踪仪i rx 跟踪仪i ] T , after substituting into formula (8), formula (2), and formula (4), we get B i The function of X is shown in formula (5);

[0082] Then B i It can be expressed as:

[0083]

[0084] Then, when there are n measurement points, the system of equations can be combined to obtain formula (6):

[0085]

[0086] Where, Y=[Y1Y2…Y n ] T, is the motion control position obtained by sending n motion control instructions to the six-degree-of-freedom motion platform. F(X) is B i The simultaneous equations of ;

[0087] Next, we use Newton's downhill method to iteratively solve the problem:

[0088] Set initial value X0 = [000000000000] T ,

[0089] Iterate according to formula (9):

[0090] X k+1 =X k -(J T J) -1 [J T (F(X k )-Y)] (9)

[0091] Where J is Y=F(X k ), as shown in Formula (10),

[0092]

[0093] X k is the value of X at the kth iteration, X k+1 is the value of X at the k+1th iteration, k = 0, 1, ...;

[0094] When (J T J) -1 [J T (F(X k )-Y)]<ε, the iteration stops, where ε is the artificially set control threshold;

[0095] At this time, we can obtain X = [Δrz1Δry1Δrx1 dx1 dy1 dz1 dx2 dy2 dz2Δrz2Δry2Δrx2] T ,

[0096] Among them, the first six items Δrz1, Δry1, Δrx1, dx1, dy1, and dz1 are used to adjust the world coordinate system posture of the laser tracker measurement software, and the last six items dx2, dy2, dz2, Δrz2, Δry2, and Δrx2 are used to adjust the control center posture of the six-degree-of-freedom motion platform.

[0097] This technical solution can improve the accuracy of finding the world coordinate system and the actual control center by correcting the two major errors: the control center binding position error and the error between the world coordinate system of the six-degree-of-freedom motion platform and the world coordinate system of the laser tracker. By combining the laser tracker and hardware devices such as T-MAC to build a measurement model, the calibration of the six-degree-of-freedom motion platform can be completed well. After the measurement error is corrected and eliminated, the platform provides real-time platform control values ​​in the motion state, and the measurement values ​​are obtained in real time through the relatively fixed T-MAC hardware device. The real-time dynamic calibration can be completed by comparing the two. This method has high accuracy and efficiency and can be widely used in six-degree-of-freedom motion platforms.

[0098] The measuring equipment used in the above technical solution can be replaced by measuring equipment with similar functions. The laser tracker can be replaced by a large-scale three-coordinate measuring device, such as photogrammetry; T-MAC can be replaced by other six-degree-of-freedom sensors or other measuring methods, such as realizing coordinate system construction through three fixed targets.

[0099] The above embodiments are intended to illustrate the present invention, not to limit the present invention. Any solution that is a simple transformation of the present invention belongs to the protection scope of the present invention.

Claims

1. Positioning method of the control center of the six-degree-of-freedom motion platform, Features: The following steps are involved: S1. Use traditional methods to roughly locate the initial position of the world coordinate system and control center of the six-degree-of-freedom motion platform; S2, using laser tracker and T-MAC probe to measure a large number of motion poses evenly distributed within the travel range of the six-degree-of-freedom motion platform; S3, according to the measurement model of the six-degree-of-freedom motion platform, using the motion posture in step S2 as a parameter, obtaining the six-degree-of-freedom motion platform control center position deviation and the world coordinate system position deviation through optimal fitting; S4, using the two deviations obtained by fitting in step S3, respectively adjusting the control center position of the six-degree-of-freedom motion platform and the world coordinate system position in the laser tracker measurement software; S5. The position and posture of the six-degree-of-freedom motion platform are directly measured by the T-MAC probe.

2. The positioning method of the control center of the six-degree-of-freedom motion platform as claimed in claim 1, Features: In step S1, a round of rough positioning of the control center and the world coordinate system of the six-degree-of-freedom motion platform is performed by traditional methods: the pin hole at the center position of the surface of the six-degree-of-freedom motion platform is used as the control center of the six-degree-of-freedom motion platform, the control center position when the six-degree-of-freedom motion platform is in a zero point state is used as the origin of the measurement coordinate system, and the three coordinate axis directions of the six-degree-of-freedom motion platform are used as the directions of the three axes of the measurement coordinate system.

3. The positioning method of the control center of the six-degree-of-freedom motion platform as claimed in claim 1, Features: In step S2: based on the rough positioning in step S1, a group of i-point motion control instructions P are sent to the six-degree-of-freedom motion platform. 6d平台i (x 平台i ,y 平台i ,z 平台i ,rx 平台i ,ry 平台i ,rz 平台i ), and obtain a set of corresponding tracker values ​​P at i points 6d跟踪仪i (x 跟踪仪i ,y 跟踪仪i ,z 跟踪仪i ,rx 跟踪仪i ,ry 跟踪仪i ,rz 跟踪仪i ), and this set of measured values ​​is used as the best fitting parameters in step S3.

4. The positioning method of the control center of the six-degree-of-freedom motion platform as claimed in claim 1, Features: In step S3, P 6d The matrix formula of the six-degree-of-freedom point (x, y, z, rx, ry, rz) is: 6Dmartix=Trans(x,y,z)×Rotz(rz)×Roty(ry)×Rotx(rx)×I (1) Substituting the i-group parameters obtained in step S2 into formula (1), we get the following objective function formula (2): 6Dmartix 六自由度平台控制值i =Rotz(Δrz 1 )×Roty(Δry 1 )×Rotx(Δrx 1 )×Trans(dx 1 ,dy 1 ,dz 1 ) (2) ×6Dmartix 激光跟踪仪测量值i ×Trans(dx 2 ,dy 2 ,dz 2 )×Rotz(Δrz 2 )×Roty(Δry 2 )×Rotx(Δrx 2 ) Where, 6Dmartix 六自由度平台控制值i and 6Dmartix 激光跟踪仪测量值i is to set P 6d平台i (x 平台i ,y 平台i ,z 平台i ,rx 平台i ,ry 平台i ,rz 平台i ) and P 6d跟踪仪i (x 跟踪仪i ,y 跟踪仪i ,z 跟踪仪i ,rx 跟踪仪i ,ry 跟踪仪i ,rz 跟踪仪i ) is substituted into the matrix form calculated by formula (1); At the same time, the matrix part of formula (1) is expanded and listed, where 6Dmartix[ij] is the i-th row and j-th column of the 6Dmartix matrix: Formula (3) can be further deduced to obtain formula (4): rx=arctan(6Dmartix[3 2] / 6Dmartix[3 3]) rz=arctan(6Dmartix[21] / 6Dmartix[11]) x = 6Dmartix[14] y=6Dmartix[24] z=6Dmartix[34] (4) 6Dmartix 激光跟踪仪测量值i Substituting into formula (2) and formula (4), we get B i The function of X is shown in formula (5): Where X = [Δrz 1 Δry 1 Δrx 1 dx 1 dy 1 dz 1 dx 2 dy 2 dz 2 Δrz 2 Δry 2 Δrx 2 ] T Then, when there are n measurement points, the system of equations can be combined to obtain formula (6): Where Y = [Y 1 Y 2 …Y n ] T , is the motion control position obtained by sending n motion control instructions to the six-degree-of-freedom motion platform, Y i =[x 平台i y 平台i z 平台i rz 平台i ry 平台i rx 平台i ] T F(X) is B i The simultaneous equations of ; Let the zero matrix be X = [Δrz 1 Δry 1 Δrx 1 dx 1 dy 1 dz 1 dx 2 dy 2 dz 2 Δrz 2 Δry 2 Δrx 2 ] T The initial value of is iterated according to formula (9), X k+1 =X k -(J T J) -1 [J T (F(X k )-Y)] (9) Where J is Y=F(X k ), the Newton downhill method is used to iterate the sum of squares of the errors on both sides of equation (9) to obtain X, that is, (dx 1 ,dy 1 ,dz 1 ,Δrx 1 ,Δry 1 ,Δrz 1 ) and (dx 2 ,dy 2 ,dz 2 ,Δrx 2 ,Δry 2 ,Δrz 2 ) is the best fit value.

5. The positioning method of the control center of the six-degree-of-freedom motion platform as claimed in claim 1, Features: In step S4, the (dx 1 ,dy 1 ,dz 1 ,Δrx 1 ,Δry 1 ,Δrz 1 ) is used to adjust the position of the world coordinate system in the tracker measurement software; (dx 2 ,dy 2 ,dz 2 ,Δrx 2 ,Δry 2 ,Δrz 2 ) The control software used for the six-degree-of-freedom motion platform adjusts the position and posture of the control center of the six-degree-of-freedom motion platform.

Citation Information

Patent Citations

  • Pose resolution analysis method for six-degree-of-freedom parallel mechanism

    CN114131596A

  • Tool path and speed planning method and device for five-axis parallel machining robot

    CN116690577A

  • Pose error measurement, calibration and compensation method for six-degree-of-freedom platform

    CN117506904A

  • A system and a method for mapping a magnetic field

    WO2015155775A1