CN113183137B - Parameter calibration device and method for six-degree-of-freedom parallel mechanism - Google Patents
Parameter calibration device and method for six-degree-of-freedom parallel mechanism Download PDFInfo
- Publication number
- CN113183137B CN113183137B CN202110605493.1A CN202110605493A CN113183137B CN 113183137 B CN113183137 B CN 113183137B CN 202110605493 A CN202110605493 A CN 202110605493A CN 113183137 B CN113183137 B CN 113183137B
- Authority
- CN
- China
- Prior art keywords
- degree
- parallel mechanism
- freedom parallel
- nominal
- displacement sensor
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/003—Programme-controlled manipulators having parallel kinematics
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
- B25J13/088—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices with position, velocity or acceleration sensors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
Abstract
The invention relates to a parameter calibration device and a parameter calibration method for a six-degree-of-freedom parallel mechanism, wherein the parameter calibration device comprises a displacement sensor, a sensor seat, a measured reference block, a support and a parameter calibration calculation module; the sensor seat comprises three mutually orthogonal planes, 1,2 and 3 displacement sensors are respectively fixed on the three planes, the axis of a measuring rod of each displacement sensor is vertical to the corresponding plane, and the sensor seat is fixed on a fixed platform of the six-degree-of-freedom parallel mechanism through a support; the measured reference block comprises three mutually orthogonal reference planes which correspond to the three planes one by one, contacts of the displacement sensor are contacted with the corresponding reference planes, and the measured reference block is fixed at the top of the movable platform of the six-degree-of-freedom parallel mechanism; and the parameter calibration calculation module calibrates and compensates the parameters of the six-degree-of-freedom parallel mechanism. The parameter calibration device for the six-degree-of-freedom parallel mechanism has the advantages of low cost, simplicity in operation, time and labor saving, high calibration efficiency and the like.
Description
Technical Field
The invention relates to the technical field of mechanics, in particular to a parameter calibration device and method for a six-degree-of-freedom parallel mechanism.
Background
The six-degree-of-freedom parallel mechanism has the advantages of high precision, high rigidity, no accumulated error and the like, and is widely applied to the fields of fine adjustment, ultra-precision machining and the like of optical elements.
Due to the existence of processing and assembling errors, certain deviation exists between the actual structural parameters and the theoretical structural parameters of the six-degree-of-freedom parallel mechanism, so that certain deviation exists between a kinematic model established according to the theoretical parameters and an actual structure. The machining error of the structural part can be reduced by adopting a high-precision machine tool, but the cost is high, and the error is compensated by parameter calibration, so that the method is low in cost and effective.
In the calibration process of the six-degree-of-freedom parallel mechanism, the pose of the six-degree-of-freedom parallel mechanism needs to be measured. At present, three-coordinate measuring machines, measuring arms, laser trackers, laser interferometers and other equipment are mostly adopted for pose measurement, and although the equipment has the characteristics of high precision, wide adaptability and the like, the equipment is expensive in manufacturing cost, time-consuming and labor-consuming in operation, high in operation requirement and inconvenient in application, so that the calibration efficiency is low, and particularly, the parallel mechanism with a large working space is more obvious. Some poses of the moving platform may not be measured due to space limitations, and satisfactory measurement data is difficult to obtain when the moving platform changes poses within a large working space. Therefore, it is necessary to consider other simple and efficient pose measurement means and improve the calibration efficiency.
Disclosure of Invention
Therefore, it is necessary to provide a simple and efficient parameter calibration device and method for a six-degree-of-freedom parallel mechanism to solve the problems of high cost, time and labor consuming operation, low calibration efficiency, low calibration precision and the like of the calibration method for the six-degree-of-freedom parallel mechanism in the prior art, so as to achieve the purposes of reducing cost, simplifying calibration process and improving calibration efficiency.
In order to achieve the purpose, the invention adopts the following technical scheme:
a parameter calibration device for a six-degree-of-freedom parallel mechanism comprises a displacement sensor, a sensor seat, a measured reference block, a bracket and a parameter calibration calculation module;
the sensor seat comprises three mutually orthogonal planes, 1,2 and 3 displacement sensors are respectively fixed on the three planes, the axes of measuring rods of the displacement sensors are vertical to the corresponding planes, and the sensor seat is fixed on a fixed platform of a six-degree-of-freedom parallel mechanism through the bracket;
the measured reference block comprises three mutually orthogonal reference planes which correspond to the three planes one by one, contacts of the displacement sensor are in contact with the corresponding reference planes, and the measured reference block is fixed at the top of the movable platform of the six-degree-of-freedom parallel mechanism;
the parameter calibration calculation module acquires actual values of the expansion amount of each displacement sensor when the six-degree-of-freedom parallel mechanism is in different poses, determines the optimal structure parameter error of the six-degree-of-freedom parallel mechanism according to the actual values of the expansion amount, and calibrates and compensates the parameters of the six-degree-of-freedom parallel mechanism according to the optimal structure parameter error.
The invention also provides a parameter calibration method based on the six-degree-of-freedom parallel mechanism parameter calibration device, wherein the parameter calibration calculation module is used for executing the parameter calibration method, and the parameter calibration method comprises the following steps:
s1: presetting an initial value of a structural parameter of the six-degree-of-freedom parallel mechanism, and adding a corresponding structural parameter error to the structural parameter of the six-degree-of-freedom parallel mechanism;
s2: presetting an initial value of a structural parameter of the six-degree-of-freedom parallel mechanism parameter calibration device, and adding a corresponding structural parameter error to the structural parameter of the six-degree-of-freedom parallel mechanism parameter calibration device;
s3: presetting nominal poses of a movable platform of a six-degree-of-freedom parallel mechanism, wherein the number of the nominal poses is greater than or equal to a lower limit value;
s4: calculating the nominal value of the expansion amount of each displacement sensor under each nominal pose;
s5: driving a six-degree-of-freedom parallel mechanism by using a controller to enable the movable platform to move to each nominal pose, and recording the actual value of the expansion amount of each displacement sensor under each nominal pose;
s6: subtracting the actual value of the expansion amount of each displacement sensor under each nominal pose from the nominal value of the expansion amount to obtain an indication value error of each displacement sensor under each nominal pose;
s7: constructing a mathematical model of an optimization problem by taking the minimum sum of squares of indication errors of all the displacement sensors as an objective function and taking structural parameter errors of the six-degree-of-freedom parallel mechanism and the six-degree-of-freedom parallel mechanism parameter calibration device as design variables;
s8: searching out the optimal solution of the mathematical model by using advanced optimization software;
s9: and substituting the optimal solution obtained by searching into a mathematical model of the six-degree-of-freedom parallel mechanism to realize parameter calibration and compensation of the six-degree-of-freedom parallel mechanism.
Compared with the prior art, the invention has the following beneficial effects:
1) low cost
The six-degree-of-freedom parallel mechanism parameter calibration device mainly comprises the following components: compared with expensive instruments such as a three-coordinate measuring machine, a laser tracker and the like, the six high-precision displacement sensors, the measured reference block and the sensor seat have extremely low cost;
2) simple operation
Before calibration, parameter calibration can be carried out only by fixing a measured reference block on a movable platform of the six-degree-of-freedom parallel mechanism, fixing a displacement sensor on a sensor seat and fixing the sensor seat on a fixed platform of the six-degree-of-freedom parallel mechanism through a support; during calibration, only the controller of the six-degree-of-freedom parallel mechanism needs to be operated, and the parameter calibration device of the six-degree-of-freedom parallel mechanism does not need to be operated, so that the whole calibration process is simple to operate, and time and labor are saved;
3) high calibration efficiency
As long as the end pose of the six-degree-of-freedom parallel mechanism is changed, the measured value of the displacement sensor, namely the actual value of the stretching amount, can be instantly obtained, the pose does not need to be solved, the actual value of the stretching amount of the displacement sensor is subtracted from the nominal value of the stretching amount, the difference is substituted into advanced optimization software, the optimal structure parameter error of the six-degree-of-freedom parallel mechanism can be calculated in a short time, and the parameter calibration efficiency is greatly improved.
Drawings
FIG. 1 is a schematic structural diagram of a parameter calibration apparatus for a six-degree-of-freedom parallel mechanism according to an embodiment of the present invention;
FIG. 2 is a schematic view of the sensor mount and bracket of FIG. 1 shown without the sensor mount and bracket;
FIG. 3 is a schematic view of the displacement sensor of FIG. 1 in relation to the sensor receptacle;
FIG. 4 is a schematic diagram of the relationship between the displacement sensor and the reference block to be measured in FIG. 1;
FIG. 5 is a schematic flow chart illustrating a method for calibrating parameters of a six-degree-of-freedom parallel mechanism according to an embodiment of the present invention.
Detailed Description
The technical solution of the present invention will be described in detail with reference to the accompanying drawings and preferred embodiments.
In one embodiment, as shown in fig. 1 to 4, the invention discloses a parameter calibration device for a six-degree-of-freedom parallel mechanism, which mainly comprises: the six displacement sensors are respectively a displacement sensor 1-a displacement sensor 6, a sensor seat 7, a measured reference block 8, a support 9 and a parameter calibration calculation module.
Specifically, the sensor seat 7 comprises three mutually orthogonal planes which are a plane 7-1, a plane 7-2 and a plane 7-3 respectively, the plane 7-1 is fixedly provided with the displacement sensor 1, the displacement sensor 2 and the displacement sensor 3, the plane 7-2 is fixedly provided with the displacement sensor 4 and the displacement sensor 5, the plane 7-3 is fixedly provided with the displacement sensor 6, and the axes of measuring rods of the displacement sensor 1 to the displacement sensor 6 are vertical to the corresponding planes. The sensor seat 7 is fixed on a fixed platform 10 of the six-degree-of-freedom parallel mechanism through a support 9, and the sensor seat 7 and the support 9 are not in contact with a movable platform 11 of the six-degree-of-freedom parallel mechanism.
Preferably, the displacement sensor in this embodiment is a grating displacement sensor, which has the characteristics of large detection range, high detection precision and fast response speed, for example, a czech ESSA grating displacement sensor SM30 series may be used.
Optionally, the sensor seat 7 is a hollow cuboid or a cube with an open bottom, and the inner hollow of the cuboid or the cube is used for accommodating the measured reference block 8.
The measured reference block 8 comprises three mutually orthogonal reference planes which are respectively in one-to-one correspondence with the planes 7-1, 7-2 and 7-3 and are respectively a reference plane 8-1, a reference plane 8-2 and a reference plane 8-3, and the contacts of the displacement sensors are in contact with the corresponding reference planes, namely the contacts of the displacement sensors 1,2 and 3 are in contact with the reference plane 8-1 of the measured reference block 8, the contacts of the displacement sensors 4 and 5 are in contact with the reference plane 8-2 of the measured reference block 8, and the contact of the displacement sensor 6 is in contact with the reference plane 8-3 of the measured reference block 8. The measured reference block 8 is fixed on the top of a movable platform 11 of the six-degree-of-freedom parallel mechanism.
Optionally, the measured reference block 8 is a cuboid or a cube, and the measured reference block 8 may have a solid structure or a hollow structure, which is not limited herein.
Optionally, the sensor seat 7 and the measured reference block 8 are made of cast iron, and the bracket 9 is made of 45 # steel, so that the sensor seat has the advantages of high strength, difficulty in deformation and the like.
The parameter calibration calculation module acquires the actual values of the expansion amounts of the displacement sensors when the six-degree-of-freedom parallel mechanism is in different poses, determines the optimal structure parameter error of the six-degree-of-freedom parallel mechanism according to the actual values of the expansion amounts, and calibrates and compensates the parameters of the six-degree-of-freedom parallel mechanism according to the optimal structure parameter error.
The parameter calibration device for the six-degree-of-freedom parallel mechanism provided by the embodiment has the advantages of low cost, simplicity in operation, time and labor saving, high calibration efficiency and the like.
In another embodiment, the present invention provides a method for calibrating parameters of a six-degree-of-freedom parallel mechanism, which is implemented based on the parameter calibration apparatus of a six-degree-of-freedom parallel mechanism described in the foregoing embodiment, and the structure of the parameter calibration apparatus of a six-degree-of-freedom parallel mechanism is referred to the foregoing embodiment and is not described herein again. The parameter calibration calculation module is used for executing the parameter calibration method of the six-degree-of-freedom parallel mechanism in the embodiment, and specifically, the parameter calibration method comprises the following steps:
s1 (S100): the initial value of the structural parameter of the six-degree-of-freedom parallel mechanism is preset, and the corresponding structural parameter error is added to the structural parameter of the six-degree-of-freedom parallel mechanism.
The structural parameters of the six-degree-of-freedom parallel mechanism comprise coordinates of six hinge points on a fixed platform of the six-degree-of-freedom parallel mechanism under a fixed platform coordinate system, coordinates of six hinge points on a movable platform under a movable platform coordinate system and lengths of six branched chains. Specifically, the number of the structural parameters of the six-degree-of-freedom parallel mechanism is 42 in total, and the structural parameters are X respectivelyBi,YBi,ZBi,li,XPi,YPi,ZPi(i ═ 1,2,3,4,5,6), where:
(1)[XBi YBi ZBi]＝[nXBi nYBi nZBi]+[ΔXBi ΔYBi ΔZBi]is the coordinate of the ith hinge point on the fixed platform of the six-freedom parallel mechanism in the fixed platform coordinate system (hereinafter referred to as fixed system)nXBi nYBi nZBi]To settle downNominal value of coordinates of the ith hinge point of the table, and the upper left-hand symbol n is the abbreviation for "nominal" (the same applies hereinafter), [ Δ X [ ]Bi ΔYBiΔZBi]The coordinate error of the ith hinge point of the fixed platform is determined;
(2)[XPi YPi ZPi]＝[nXPi nYPi nZPi]+[ΔXPi ΔYPi ΔZPi]is the coordinate of the ith hinge point on the moving platform of the six-freedom parallel mechanism in the moving platform coordinate system (hereinafter referred to as the moving system)nXPi nYPi nZPi]Is the coordinate nominal value of the ith hinge point of the movable platform, [ Delta X ]Pi AYPi ΔZPi]The coordinate error of the ith hinge point of the movable platform is obtained;
(3)li＝nli+Δlilength l of ith branched chain of six-freedom parallel mechanismi，nliIs a nominal value of the length of the ith branch,. DELTA.liThe length error of the ith branch is shown.
S2 (S200): presetting an initial value of the structural parameter of the six-degree-of-freedom parallel mechanism parameter calibration device, and adding a corresponding structural parameter error for the structural parameter of the six-degree-of-freedom parallel mechanism parameter calibration device.
Optionally, the step of presetting the initial value of the structural parameter of the six-degree-of-freedom parallel mechanism parameter calibration device by S2 includes the following steps:
s21: and constructing a coordinate system of the measured reference block.
Firstly, a parameter calibration device of a six-degree-of-freedom parallel mechanism is modeled. The intersection point of three planes of a measured reference block 8 is abstracted as the origin of a measured reference block coordinate system (hereinafter, referred to as a reference block system), a reference plane 8-1 is abstracted as an XOY plane of the reference block system and is abbreviated as an 'I plane', the intersection line of the reference plane 8-1 and a reference plane 8-2 is abstracted as an X axis, a plane passing through the X axis and perpendicular to the reference plane 8-1 is defined as an XOZ plane and is abbreviated as a 'II plane', and a plane passing through the origin and perpendicular to the X axis is defined as a YOZ plane and is abbreviated as a 'III plane'. And constructing a coordinate system of the measured reference block. The displacement sensors 1 to 6 are abstracted into spatial straight lines S1 to S6, wherein the intersections of the straight lines S1, S2 and S3 with the plane I are defined as M1, M2 and M3, the intersections of the straight lines S4 and S5 with the plane II are defined as M4 and M5, and the intersection of the straight line S6 with the plane III is defined as M6.
S22: presetting the pose of the coordinate system of the measured reference block under the six-freedom-degree parallel mechanism dynamic system.
The pose of the preset reference block system under the six-freedom-degree parallel mechanism dynamic system is as follows:
in the formula:
Writing equation (1) as a homogeneous coordinate transformation is:
in the formula, c represents cos and s represents sin.
S23: and presetting the pose of the measured reference block under the fixed platform coordinate system of the six-degree-of-freedom parallel mechanism when the movable platform coordinate system is at the zero position to obtain expressions of an XOY surface, an XOZ surface and a YOZ surface of the measured reference block when the movable platform coordinate system is at the zero position.
In this step, the pose of the reference block system under the fixed system of the six-degree-of-freedom parallel mechanism when the preset dynamic system is at the zero position is expressed by an RPY angle:
in the formula:
Writing equation (3) as a homogeneous coordinate transformation form:
in the formula, c represents cos and s represents sin.
An expression of the I surface of the measured reference block when the dynamic system is at the zero position can be obtained according to the formula (4):
in the formula (I), the compound is shown in the specification,
is a point on the I surface, namely the coordinate origin of the reference block system,
and
is a vector in the I plane.
And when the dynamic system is at the zero position, the expression of the II surface of the measured reference block is as follows:
in the formula (I), the compound is shown in the specification,
is a point on the surface II of the wafer,
and
is a vector in the plane II.
And the expression of the III surface of the measured reference block when the dynamic system is at the zero position:
in the formula (I), the compound is shown in the specification,
is a point on the plane III of the wafer,
and
is a vector in plane III.
S24: and presetting expressions of straight lines where the displacement sensors are located.
Presetting linear expressions of the displacement sensors 1 to 6:
Lk＝[xk yk zk dxk dyk dzk],k＝1,2,3,4,5,6 (8)
in the formula:
[xk yk zk]＝[nxk nyk nzk]+[Δxk Δyk Δzk]represents a point coordinate on a straight linenxk nyk nzk]Is a nominal value of the coordinates of a point on a straight line, [ Δ x ]k Δyk Δzk]Is the coordinate error of a point on the straight line;
[dxk dyk dzk]＝[ndxk ndyk ndzk]+[Δdxk Δdyk Δdzk]a vector [ alpha ] representing a straight linendxk ndyk ndzk]Is the nominal value of the vector of the straight line, [ Δ dx ]k Δdyk Δdzk]Is the vector error of the straight line.
Through the steps from S21 to S24, the structural parameters of the parameter calibration device for the six-degree-of-freedom parallel mechanism are preset, and the total number of the structural parameters is 48.
S3 (S300): the nominal poses of the movable platform of the six-degree-of-freedom parallel mechanism are preset, and the number of the nominal poses is larger than or equal to a lower limit value.
The nominal poses of a movable platform of a preset six-degree-of-freedom parallel mechanism are as follows:
in the formula (I), the compound is shown in the specification,
is the coordinate of the coordinate origin of the motion system in the fixed system under the j-th nominal pose,
and j is equal to or more than m, m is a lower limit value of the number of the nominal poses, and optionally, m is 15.
S4 (S400): and calculating the nominal value of the expansion amount of each displacement sensor under each nominal pose.
Optionally, the step of S4 calculating the nominal value of the expansion amount of each displacement sensor at each nominal pose includes the following steps:
s41: and calculating the zero position coordinates of the contact points of the displacement sensors and the corresponding coordinate plane in the reference block system in the fixed system when the dynamic system is in the zero position. When equations (5), (6), (7), and (8) are combined, the coordinates of the contact point can be obtained and are recorded as:
in the formula (I), the compound is shown in the specification,
the coordinate of the displacement sensor k and the contact of the corresponding coordinate plane in the reference block system in the fixed system when the moving system is at the zero position is the zero position coordinate.
S42: and calculating the position and attitude coordinates of each displacement sensor and the contact of the corresponding coordinate plane in the reference block system in the fixed system when the dynamic system is in the nominal position and attitude.
Expressions of homogeneous coordinate transformation for different nominal poses and plane expressions of coordinate planes I, II and III in different nominal poses can be derived from S1-S3. The linear expression of the displacement sensor is combined with the plane expressions of the coordinate planes I, II and III under different nominal poses, so that the coordinates of the contact points of each displacement sensor and each corresponding coordinate plane in the reference block system can be solved and recorded as:
in the formula (I), the compound is shown in the specification,
the coordinates of the displacement sensor k of the motion system in each position and the contact of the corresponding coordinate plane in the reference block system in the fixed system are the position coordinates.
S43: and calculating the linear distance between two contacts of each displacement sensor under each nominal pose according to the zero position coordinates and the pose coordinates to obtain the nominal value of the expansion amount of each displacement sensor under each nominal pose.
Calculating the linear distance between two contact points of each displacement sensor when the dynamic system is at a zero position and the dynamic system is at a nominal pose according to the formula (10) and the formula (11):
when the contact when the dynamic system is in the nominal pose moves to the reference axis in the positive direction relative to the contact when the dynamic system is in the zero position, the nominal value of the expansion amount of the displacement sensor is regulated to be positive, namely
hk＝|hk| (13)
When the contact when the dynamic system is in the nominal pose moves towards the negative direction of the reference shaft relative to the contact when the dynamic system is in the zero position, the nominal value of the expansion amount of the specified displacement sensor is negative, namely
hk＝-|hk| (14)
The reference axis is a coordinate axis parallel to a normal of a coordinate plane corresponding to the displacement sensor in the reference block system.
Therefore, the nominal value of the expansion amount of each displacement sensor under each nominal pose is calculated and recorded as:
nHj＝[nhj1 nhj2 nhj3 nhj4 nhj5 nhj6] (15)
in the formula (I), the compound is shown in the specification,nhj1，nhj2，nhj3，nhj4，nhj5，nhj6respectively, the nominal values of the expansion and contraction amounts of the 6 displacement sensors.
S5 (S500): and driving the six-degree-of-freedom parallel mechanism by using the controller to enable the movable platform to move to each nominal pose, and recording the actual expansion value of each displacement sensor under each nominal pose.
The controller is used for driving the six-degree-of-freedom parallel mechanism to enable the movable platform to move to nominal poses in sequence, the displacement sensor is used for measuring actual values of the stretching amount under different nominal poses, and the measurement result of each nominal pose is recorded as:
aHj＝[ahj1 ahj2 ahj3 ahj4 ahj5 ahj6] (16)
in the formula (I), the compound is shown in the specification,ahj1，ahj2，ahj3，ahj4，ahj5，ahj6nominal values for the amount of expansion and contraction of 6 displacement sensors, respectively, and the upper left-hand symbol a is an abbreviation for "actual".
S6 (S600): and (3) subtracting the actual value of the stretching amount of each displacement sensor under each nominal pose from the nominal value of the stretching amount to obtain the indicating value error of each displacement sensor under each nominal pose, and recording the indicating value error of each displacement sensor under each nominal pose as follows:
ΔHj＝[Δhj1 Δhj2 Δhj3 Δhj4 Δhj5 Δhj6] (17)
in the formula,. DELTA.hj1，Δhj2，Δhj3，Δhj4，Δhj5，Δhj6The difference values of the nominal value and the actual value of the stretching amount of the 6 displacement sensors are respectively.
S7 (S700): and constructing a mathematical model of the optimization problem by taking the minimum sum of squares of indicating value errors of all displacement sensors as an objective function and taking structural parameter errors of the six-degree-of-freedom parallel mechanism and the six-degree-of-freedom parallel mechanism parameter calibration device as design variables.
In this step, a mathematical model of the optimization problem is constructed. With the least square sum of the indication errors of all displacement sensors as the objective function, i.e.
In the formula, m is the number of nominal poses.
Taking the structure parameter error of the six-freedom-degree parallel mechanism and the six-freedom-degree parallel mechanism parameter calibration device as a design variable, namely
The constraint condition of the variable is the value range of the variable under the existing processing and assembling capacity, and the error of the endpoint of the value range is +/-0.1 (mm).
S8 (S800): and searching out the optimal solution of the mathematical model by using advanced optimization software. The advanced optimization software in the invention can be realized by software in the prior art, for example, OASIS software is adopted, and the OASIS software realizes the optimal solution search of the mathematical model based on an advanced optimization algorithm to obtain the optimal solution of the mathematical model, namely the optimal structure parameter error.
S9 (S900): and substituting the optimal solution obtained by searching into a mathematical model in control software of the six-degree-of-freedom parallel mechanism to realize parameter calibration and compensation of the six-degree-of-freedom parallel mechanism.
The parameter calibration device, namely the method for the six-degree-of-freedom parallel mechanism provided by the embodiment of the invention has the following beneficial effects:
1) low cost
The six-degree-of-freedom parallel mechanism parameter calibration device mainly comprises the following components: compared with expensive instruments such as a three-coordinate measuring machine, a laser tracker and the like, the six high-precision displacement sensors, the measured reference block and the sensor seat have extremely low cost;
2) simple operation
Before calibration, parameter calibration can be carried out only by fixing a measured reference block on a movable platform of the six-degree-of-freedom parallel mechanism, fixing a displacement sensor on a sensor seat and fixing the sensor seat on a fixed platform of the six-degree-of-freedom parallel mechanism through a support; during calibration, only the controller of the six-degree-of-freedom parallel mechanism needs to be operated, and a parameter calibration device of the six-degree-of-freedom parallel mechanism does not need to be operated, so that the whole calibration process is simple to operate, and time and labor are saved;
3) high calibration efficiency
As long as the end pose of the six-degree-of-freedom parallel mechanism is changed, the measured value of the displacement sensor, namely the actual value of the stretching amount, can be instantly obtained, the pose does not need to be solved, the actual value of the stretching amount of the displacement sensor is subtracted from the nominal value of the stretching amount, the difference is substituted into advanced optimization software, the optimal structure parameter error of the six-degree-of-freedom parallel mechanism can be calculated in a short time, and the parameter calibration efficiency is greatly improved.
The technical features of the embodiments described above may be arbitrarily combined, and for the sake of brevity, all possible combinations of the technical features in the embodiments described above are not described, but should be considered as being within the scope of the present specification as long as there is no contradiction between the combinations of the technical features.
The above-mentioned embodiments only express several embodiments of the present invention, and the description thereof is more specific and detailed, but not construed as limiting the scope of the invention. It should be noted that various changes and modifications can be made by those skilled in the art without departing from the spirit of the invention, and these changes and modifications are all within the scope of the invention. Therefore, the protection scope of the present patent shall be subject to the appended claims.
Claims (5)
1. A parameter calibration method based on a six-degree-of-freedom parallel mechanism parameter calibration device comprises a displacement sensor, a sensor seat (7), a measured reference block (8), a support (9) and a parameter calibration calculation module;
the sensor seat (7) comprises three mutually orthogonal planes, 1,2 and 3 displacement sensors are respectively fixed on the three planes, the axes of measuring rods of the displacement sensors are vertical to the corresponding planes, and the sensor seat (7) is fixed on a fixed platform (10) of the six-degree-of-freedom parallel mechanism through the bracket (9);
the measured reference block (8) comprises three mutually orthogonal reference planes which correspond to the three planes one by one, contacts of the displacement sensor are all contacted with the corresponding reference planes, and the measured reference block (8) is fixed at the top of a movable platform (11) of the six-degree-of-freedom parallel mechanism;
the parameter calibration calculation module acquires actual values of the expansion amount of each displacement sensor when the six-degree-of-freedom parallel mechanism is in different poses, determines the optimal structure parameter error of the six-degree-of-freedom parallel mechanism according to the actual values of the expansion amount, and calibrates and compensates the parameters of the six-degree-of-freedom parallel mechanism according to the optimal structure parameter error; the parameter calibration calculation module is used for executing the parameter calibration method, and the parameter calibration method comprises the following steps:
s1: presetting an initial value of a structural parameter of the six-degree-of-freedom parallel mechanism, and adding a corresponding structural parameter error to the structural parameter of the six-degree-of-freedom parallel mechanism;
s2: presetting an initial value of a structural parameter of the six-degree-of-freedom parallel mechanism parameter calibration device, and adding a corresponding structural parameter error to the structural parameter of the six-degree-of-freedom parallel mechanism parameter calibration device;
s3: presetting nominal poses of a movable platform of a six-degree-of-freedom parallel mechanism, wherein the number of the nominal poses is greater than or equal to a lower limit value;
s4: calculating the nominal value of the expansion amount of each displacement sensor under each nominal pose;
s5: driving a six-degree-of-freedom parallel mechanism by using a controller to enable the movable platform to move to each nominal pose, and recording the actual value of the expansion amount of each displacement sensor under each nominal pose;
s6: the actual value of the expansion amount of each displacement sensor under each nominal pose is subtracted from the nominal value of the expansion amount to obtain an indication value error of each displacement sensor under each nominal pose;
s7: and constructing a mathematical model of an optimization problem by taking the minimum sum of squares of indication errors of all the displacement sensors as an objective function and taking structural parameter errors of the six-degree-of-freedom parallel mechanism and the six-degree-of-freedom parallel mechanism parameter calibration device as design variables:
in the formula, m is the number of nominal poses, and j and k are variable symbols;
s8: searching out the optimal solution of the mathematical model by using optimization software;
s9: and substituting the optimal solution obtained by searching into a mathematical model of the six-degree-of-freedom parallel mechanism to realize parameter calibration and compensation of the six-degree-of-freedom parallel mechanism.
2. The parameter calibration method according to claim 1,
the structural parameters of the six-degree-of-freedom parallel mechanism comprise coordinates of six hinge points on a fixed platform of the six-degree-of-freedom parallel mechanism under a fixed platform coordinate system, coordinates of six hinge points on a movable platform under a movable platform coordinate system and the lengths of six branched chains.
3. The parameter calibration method according to claim 1 or 2, wherein the step S2 includes the following steps:
constructing a coordinate system of a measured reference block;
presetting the pose of the coordinate system of the measured reference block under the coordinate system of the six-degree-of-freedom parallel mechanism moving platform;
presetting the pose of the measured reference block under the fixed platform coordinate system of the six-degree-of-freedom parallel mechanism when the movable platform coordinate system is at a zero position to obtain expressions of an XOY surface, an XOZ surface and a YOZ surface of the measured reference block when the movable platform coordinate system is at the zero position;
and presetting an expression of a straight line where each displacement sensor is located.
4. The parameter calibration method according to claim 1 or 2, wherein S4 comprises the following steps:
s41: calculating zero coordinates of each displacement sensor and a contact of a corresponding coordinate plane in the coordinate system of the reference block to be measured in the coordinate system of the fixed platform when the coordinate system of the movable platform is at the zero position;
s42: calculating the position and attitude coordinates of each displacement sensor and a contact of a corresponding coordinate plane in the coordinate system of the measured reference block in the coordinate system of the fixed platform when the coordinate system of the movable platform is in the nominal position and attitude;
s43: and calculating the linear distance between two contacts of each displacement sensor under each nominal pose according to the zero position coordinates and the pose coordinates to obtain the nominal value of the expansion amount of each displacement sensor under each nominal pose.
5. The parameter calibration method according to claim 4,
when the contact of the moving platform coordinate system in the nominal pose moves towards the reference axis in the positive direction relative to the contact of the moving platform coordinate system in the zero position, the nominal value of the stretching amount of the displacement sensor is positive, and when the contact moves towards the negative direction of the reference axis, the nominal value of the stretching amount of the displacement sensor is negative.
Applications Claiming Priority (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202010595602.1A CN111716331A (en) | 2020-06-28 | 2020-06-28 | Six-degree-of-freedom parallel mechanism parameter calibration device and method |
| CN2020105956021 | 2020-06-28 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN113183137A CN113183137A (en) | 2021-07-30 |
| CN113183137B true CN113183137B (en) | 2022-07-01 |
Family
ID=72568938
Family Applications (2)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202010595602.1A Pending CN111716331A (en) | 2020-06-28 | 2020-06-28 | Six-degree-of-freedom parallel mechanism parameter calibration device and method |
| CN202110605493.1A Active CN113183137B (en) | 2020-06-28 | 2021-05-31 | Parameter calibration device and method for six-degree-of-freedom parallel mechanism |
Family Applications Before (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202010595602.1A Pending CN111716331A (en) | 2020-06-28 | 2020-06-28 | Six-degree-of-freedom parallel mechanism parameter calibration device and method |
Country Status (1)
| Country | Link |
|---|---|
| CN (2) | CN111716331A (en) |
Families Citing this family (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113091670B (en) * | 2021-04-13 | 2022-02-11 | 上海大学 | Calibration device and calibration method for robot joint stiffness |
| CN113514017B (en) * | 2021-05-06 | 2022-08-16 | 南京理工大学 | Parallel driving mechanism moving platform pose measuring method |
| CN113532352B (en) * | 2021-06-23 | 2023-09-19 | 中国科学院长春光学精密机械与物理研究所 | Six-degree-of-freedom displacement platform position detection method |
| CN113865485B (en) * | 2021-09-26 | 2022-10-25 | 西安交通大学 | Precision optimization method and system of six-degree-of-freedom adjustment platform for off-axis aspheric element |
| CN113771093A (en) * | 2021-09-28 | 2021-12-10 | 浙江大学湖州研究院 | Mechanical arm calibration and precision measurement device based on linear motion platform |
| CN114083530B (en) * | 2021-10-22 | 2023-03-31 | 中国科学院自动化研究所 | Workpiece coordinate system calibration system and method |
Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101788257A (en) * | 2010-01-14 | 2010-07-28 | 哈尔滨工业大学 | Device and method for six degrees of freedom micro pose measurement based on capacitance sensor |
| CN102278963A (en) * | 2011-06-30 | 2011-12-14 | 燕山大学 | Self-calibration method of parallel robot |
| CN103963032A (en) * | 2014-05-05 | 2014-08-06 | 中国科学院长春光学精密机械与物理研究所 | Large space optical remote sensor four-dimensional regulating device |
| CN106112971A (en) * | 2016-07-14 | 2016-11-16 | 南京林业大学 | A kind of pedestal position of articulating point self-adjustable six degree of freedom incidence flexible exoskeleton system |
| CN110500990A (en) * | 2019-07-09 | 2019-11-26 | 同济大学 | A kind of six degree of freedom measuring system and method |
| WO2020073540A1 (en) * | 2018-10-12 | 2020-04-16 | 北京理工大学 | Magnetic source detection device fixedly connecting external magnet and magnetic sensor array |
| CN111024047A (en) * | 2019-12-26 | 2020-04-17 | 北京航空航天大学 | Six-degree-of-freedom pose measurement device and method based on orthogonal binocular vision |
Family Cites Families (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US7040033B2 (en) * | 2001-10-05 | 2006-05-09 | Trustees Of Stevens Institute Of Technology | Six degrees of freedom precision measuring system |
| CN100484728C (en) * | 2006-12-28 | 2009-05-06 | 山东理工大学 | Three-translation orthogonal decoupling parallel micromotion platform |
| CN102294695A (en) * | 2010-06-25 | 2011-12-28 | 鸿富锦精密工业（深圳）有限公司 | Robot calibration method and calibration system |
| CN102152307B (en) * | 2011-01-24 | 2012-09-05 | 西安交通大学 | Inclination-angle-constraint-based kinematic calibration method for Stewart parallel robot |
| CN103471545A (en) * | 2013-09-25 | 2013-12-25 | 吉林大学 | Measuring system and measuring method for pose with six degrees of freedom |
| CN106240849B (en) * | 2016-07-22 | 2020-05-12 | 上海宇航系统工程研究所 | Spacecraft docking system and method |
| CN106052570A (en) * | 2016-08-11 | 2016-10-26 | 中国计量科学研究院 | Nanometer-displacement-bench six-degree-of-freedom calibrating device |
| CN106813638B (en) * | 2017-03-15 | 2018-05-18 | 吉林大学 | A kind of 3RPS parallel robots geometric parameter discrimination method |
| DE102017206025A1 (en) * | 2017-04-07 | 2018-10-11 | Deutsches Zentrum für Luft- und Raumfahrt e.V. | Magnetic arrangement for detecting relative movements or relative positions |
-
2020
- 2020-06-28 CN CN202010595602.1A patent/CN111716331A/en active Pending
-
2021
- 2021-05-31 CN CN202110605493.1A patent/CN113183137B/en active Active
Patent Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101788257A (en) * | 2010-01-14 | 2010-07-28 | 哈尔滨工业大学 | Device and method for six degrees of freedom micro pose measurement based on capacitance sensor |
| CN102278963A (en) * | 2011-06-30 | 2011-12-14 | 燕山大学 | Self-calibration method of parallel robot |
| CN103963032A (en) * | 2014-05-05 | 2014-08-06 | 中国科学院长春光学精密机械与物理研究所 | Large space optical remote sensor four-dimensional regulating device |
| CN106112971A (en) * | 2016-07-14 | 2016-11-16 | 南京林业大学 | A kind of pedestal position of articulating point self-adjustable six degree of freedom incidence flexible exoskeleton system |
| WO2020073540A1 (en) * | 2018-10-12 | 2020-04-16 | 北京理工大学 | Magnetic source detection device fixedly connecting external magnet and magnetic sensor array |
| CN110500990A (en) * | 2019-07-09 | 2019-11-26 | 同济大学 | A kind of six degree of freedom measuring system and method |
| CN111024047A (en) * | 2019-12-26 | 2020-04-17 | 北京航空航天大学 | Six-degree-of-freedom pose measurement device and method based on orthogonal binocular vision |
Non-Patent Citations (3)
| Title |
|---|
| Calibration of a 6-DOF parallel micromanipulator for nanomanipulation;Lefeng Wang;《Calibration of a 6-DOF parallel micromanipulator for nanomanipulation》;IEEE;20100304;全文 * |
| 分体式超大口径空间遥感器技术及其发展;杨会生;《分体式超大口径空间遥感器技术及其发展》;光学精密工程;20180615;第26卷(第6期);第1287-1297页 * |
| 工业机器人绝对定位精度测量的研究;赵建峰;《工业机器人绝对定位精度测量的研究》;机床与液压;20200215;第48卷(第3期);第24-27页 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN113183137A (en) | 2021-07-30 |
| CN111716331A (en) | 2020-09-29 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN113183137B (en) | Parameter calibration device and method for six-degree-of-freedom parallel mechanism | |
| JP4660779B2 (en) | Method for evaluating position error of moving device and method for improving moving accuracy based on the evaluation result | |
| Joubair et al. | Kinematic calibration of a five-bar planar parallel robot using all working modes | |
| Chen et al. | Real-time compensation for time-variant volumetric errors on a machining center | |
| Zhuang et al. | Kinematic calibration of a Stewart platform using pose measurements obtained by a single theodolite | |
| Chen | Computer-aided accuracy enhancement for multi-axis CNC machine tool | |
| US7040033B2 (en) | Six degrees of freedom precision measuring system | |
| US10871366B2 (en) | Supplementary metrology position coordinates determination system for use with a robot | |
| TWI728757B (en) | Direct pose feedback control method and direct pose feedback controlled machine | |
| US20140222372A1 (en) | Variable modelling of a measuring device | |
| US10913156B2 (en) | Robot system with end tool metrology position coordinates determination system | |
| US11673275B2 (en) | Through-beam auto teaching | |
| JP7158582B2 (en) | Adjustment amount estimation device, adjustment amount estimation method, adjustment amount estimation program, and machine tool assembly method | |
| He et al. | Kinematic calibration of a three degrees-of-freedom parallel manipulator with a laser tracker | |
| CN114488944A (en) | Interpolation-based servo displacement error compensation method | |
| Chen et al. | A simple two-step geometric approach for the kinematic calibration of the 3-PRS parallel manipulator | |
| CN110006378A (en) | A kind of structure detection method | |
| CN107263463B (en) | Mechanism parameter correction method for robot arm system | |
| Jiang et al. | Kinematic accuracy improvement of a novel smart structure-based parallel kinematic machine | |
| Tan et al. | Geometrical error modeling and compensation using neural networks | |
| Yagüe-Fabra et al. | Scalability of precision design principles for machines and instruments | |
| KR100332296B1 (en) | Method and apparatus for controlling parallel robots | |
| Volech et al. | Model of flexible robot with deformation detection | |
| JP4311621B2 (en) | Mechanical motion error correction method using a 6-DOF position and orientation measurement device | |
| JP3437327B2 (en) | Positioning device for semiconductor exposure equipment |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |