InTech uses cookies to offer you the best online experience. By continuing to use our site, you agree to our Privacy Policy.

Robotics » "International Journal of Advanced Robotic Systems", ISSN 1729-8806, Published: September 1, 2011 under CC BY 3.0 license. © The Author(s).

Kinematic Calibration of Parallel Robots for Docking Mechanism Motion Simulation

By Dayong Yu, Hongren Li and Weifang Chen
Regular Paper
DOI: 10.5772/45684

Article top

Overview

The kinematic relation of the parallel robot
Figure 1. The kinematic relation of the parallel robot
Experimental setup
Figure 2. Experimental setup
Coordinate measuring machine
Figure 3. Coordinate measuring machine
The relation of identification error reduction percentage and pose error reduction percentage
Figure 4. The relation of identification error reduction percentage and pose error reduction percentage
The comparison of pose error before and after calibration
Figure 5. The comparison of pose error before and after calibration

Kinematic Calibration of Parallel Robots for Docking Mechanism Motion Simulation

Dayong Yu1, Hongren Li2 and Weifang Chen1
Show details

© 2011 Author(s). Licensee InTech. This is an open access article distributed under the terms of the Creative Commons Attribution License (http://creativecommons.org/licenses/by/3.0), which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.

Abstract

A new method for calibrating a parallel robot is proposed as part of a project aimed at developing a calibration method for spacecraft docking mechanism motion simulator. To implement this method, a calibration equation is built by generating the constraint conditions of the end-effector’s motion in the workspace using a three-dimensional coordinate measuring machine. According to the established calibration equation and the simulation, the geometrical parameters of the parallel robot are identified. The effectiveness of the calibration method with a coordinate measuring machine is verified through random pose test experiment.

Keywords: Parallel Robot, Kinematic Calibration, Parameter Estimation, Optimum Pose, Accuracy

1. Introduction

Parallel robots such as a Stewart platform [1] have some advantage of high rigidity, high accuracy, and high load-carrying capacity over serial robots. However, they have some drawbacks of relatively small workspace and very difficult forward kinematics problems. These robots have found a variety of applications in flight simulators, high-precision machining centers, medical surgery, and so on.

It is well known that excellent positioning performance of the manipulator may be achieved based on an accurate kinematic equation. However, parameters of the equation inevitably deviate from their nominal values due to manufacturing and assembly errors. A direct consequence is to reduce the accuracy of the robots, since their control strategy heavily relies on a precise description of the kinematic equation. One way to tackle this problem is to improve the theoretical kinematic equation through kinematic calibration which consists of identifying a more accurate geometrical relationship between the joint sensor/encoder reading and the actual pose of the end-effector. Literatures indicated that the most economical and feasible way of enhancing the manipulator accuracy is through kinematic calibration [2-5].

Let us employ the paradigm of literature [6] in stating a unified calibration formulation. First, the principle is to link the unknown kinematic parameters P and the information on the state of the manipulator M, either provided by sensors or through constraints applied on joints or brought by an additional mechanism. Some closed loop equations f(P, M)=0 can be determined; the equations vanish within the measurement error. The simplest way to determine M is by using the internal sensors of the manipulator. Usually, though, as they do not provide redundant information, their number is minimal for controlling the manipulator’s degrees of freedom. It is possible to install additional captors on passive joints for self-calibration (with the benefit of simplifying the forward kinematics) in [7, 8]. Alternatively, one can decrease the degree of freedom by constraining the end-effector or the mobility of some joints in [9-11]; this can also be used to simplify the calibration procedure if external measurements are present by several researchers [12, 13].

In practice, it is not easy to add redundant sensors or constrain. Hence, most calibration methods use external measurements devices to obtain the required information, such as laser trackers, theodolites, cameras, inclinometers or mechanical devices in [14, 15].

Many authors use the kinematics to relate the kinematic parameters P to the available information M. Then, the basic calibration methods with external measurements use either the forward kinematics or the inverse kinematics in [16-18]. Those calibration methods may be prone to error. The reason is the difficulty to obtain a closed form for the solutions of the kinematics problem.

The work presented in this paper is at an early stage of development. The goal is to develop an effective calibration model for spacecraft docking simulator. Thus far, work has focused on developing a calibration model for the parallel robot because it is similar in form to a structure of spacecraft docking simulator. The remainder of the paper is organized as follows: In Section II, we present a new calibration scheme with error model. We describe our data measurement method in Section III. Simulation and experiment results are given in Section IV.

2. Calibration algorithm

A. Error Model

In this design, the parallel robot has 6 extensible legs that are connected by ball joints to the load platform and the base. The load platform ball joints are fixed in position relative to the load platform coordinate frame while the base ball joints are fixed in position relative to the base coordinate frame.

The error model allows for deviation in the ball joint positions and in the lengths of the legs, giving 42 error parameters in total. For the Stewart platform, the loop closure condition is given by (1). The meanings of the symbols in (1) may be inferred from Fig. 1.

t+R(ai+δai)(bi+δbi)(li+δli)l^i=0
(1)

Matrix R is the 3 by 3 rotation matrix that converts the load platform basis vectors into the base frame basis factors. The inverse geometric solution expresses the actuator coordinates as a function of the endpoint position. And the direct geometric solution expresses the endpoint position as a function of the actuator coordinates robot geometry, and error parameters. While the direct geometric solution has been solved analytically, it is much more computationally to use a numerical solution algorithm such as the Newton-Raphson algorithm in [19, 20].

The differential solution expresses rates of change in the endpoint coordinates as a function of changes in the error parameters. If the error parameters are grouped into a single 42 by 1 partitioned vector as in (2) then the direct Jacobian matrix is defined as in (4).

e=[δl1δl6δa1δa6δb1δb6]T
(2)

Where

(δai)T=[δaxiδayiδazi] (a)(δbi)T=[δbxiδbyiδbzi] (b)
(3)
J=te=[t/lit/(δai)t/(δbi)]
(4)
δli=t+R(a+δai)(b+δbi)lil^i
(5)
L¯(t,e)=[δl1δl2δl3δl4δl5δl6]
(6)

The terms in (4) are complicated to express or evaluated, but the loop closure equation (1) may be rearranged as (5) and the δli collected into a vector function (6). It may be shown that

t/(li)=[L¯(t,e)/t]1=Δ
(7)

Hence

J=[ΔΔL¯(t,e)/(δai)ΔL¯(t,e)/(δbi)]
(8)

This is easier to evaluate.

media/image9.png

Figure 1.

The kinematic relation of the parallel robot

In the following expression, the subscript represents the ordinal number of the measurement points. Each nominal measurement position tjnorm is associated with a Jacobian matrix Jj evaluated at tjnorm.

B. Calibration algorithm

The objective of error identification is to know the effective kinematic parameters of the robot in order to control accurately the endpoint position. The relationship between the measured position of the robot endpoint PM and the actual position of the robot endpoint P is as follows (see Figure 1)

Where RB and tB are the rotation matrix and position vector from the measurement system coordinate to the robot base frame, respectively. The relative position between point i and j in workspace is

pM,ipM,j=RB(pipj)
(10)

Let us consider that the actual position of the robot endpoint differs slightly from the nominal one p(n)

Then (10) becomes

pM,ipM,j=RB[(pi(n)pj(n))+(JiJj)e]
(12)

The relative position of pM,1 and pM,0 is

pM,1pM,0=RB[(p1(n)p0(n))+(J1J0)e]
(13)

If positions pM,i, pM,j and pM,0 lie on a plane, and the line pM,0 to pM,1 is perpendicular to this plane, we have

(pM,1pM,0)T(pM,ipM,j)=0
(14)

Then, from (12) and (13) we obtain

(p1(n)p0(n))T(pi(n)pj(n))+[(p1(n)p0(n))T(JiJj)+(pi(n)pj(n))T(J1J0)]e=0
(15)

Denoting,

Xi,j=(p1(n)p0(n))T(JiJj)+(pi(n)pj(n))T(J1J0)
(16)
Yi,j=(p1(n)p0(n))T(pi(n)pj(n))
(17)

Then, (15) becomes

Xi,je=Yi,j
(18)

The above calibration equation is independent of RB and pB. If we measure n points, we have n-1 equations

Where

X=[X1,2X2,3Xi,jXn1,n]T
(20)
Y=[Y1,2Y2,3Yi,jYn1,n]T
(21)

The least squares solution for e is

e=(XTX)1XTY
(22)

If E denotes the vector of original kinematic parameters, the updated kinematic parameter values are E obtained by

Since this is a nonlinear estimation problem, this procedure is iterated until the variation e approach zero and the parameters E have converged to some stable values. Perpendicular constraints between the plane and line can be obtained by coordinate measuring machine as explained in Section 3.

3. Measurement Method

The simulations and experiments were also conducted using the parallel robot, which developed in the IEST, Harbin Institute of Technology, as shown in Fig. 2. The precise three-dimension coordinate measurement machine, manufactured by STAR Tech., was used to construct the constraint conditions in the workspace, as shown in Fig. 3. This machine has a repeatability of 0.011mm and an accuracy of 0.016mm in the 1.2m×1.2m×1.2m measuring range.

Making constraints in the workspace using the 3-D coordinate measuring machine is as follows:

  1. Pose the robot endpoint in the position of any range to be measured and read the positioning coordinate from 3-D coordinate measuring machine, via the computer.

  2. Move the robot endpoints to the next position.

  3. Move the robot endpoint and let the z axis value from the 3-D coordinate measuring machine agree with the pervious value.

  4. Repeat (2)-(4) process.

Then the points lie in an arbitrary x-y plane because of the same z coordinate values. The method of obtaining one vertical line with respect to this plane is the reverse of the above method, i.e., move the robot endpoint only along with the z-axis coordinate while fixing x and y axis values of the 3-D coordinate measuring machine. The 3-D coordinate measuring machine is only used as a tool to construct a plane and perpendicular line in the workspace, not used to measure the value of the position coordinate.

media/image29.jpeg

Figure 2.

Experimental setup

media/image30.png

Figure 3.

Coordinate measuring machine

4. Simulation and Experiments

A. Simulations

Calibrations based on the geometry of the parallel robot shown in Fig. 2 were simulated with various parameter errors, noise levels, and pose sets. The nominal parameters and the workspace limits of the parallel robot are listed in Table 1 and Table 2. Three parameter sets were simulated, with the parameter deviations obtained from normal distributions with variances of 0.01mm (set 1), 0.1mm (set 2), and 1mm (set 3). Gaussian noise with variances of 0.0001mm, 0.001mm, 0.01mm, and 0.1mm was added to measurements to simulate measurement noise. Constraint set contains 100 positions selected from the workspace using a coordinate exchange algorithm for the D-optimal experimental design.

Table 3 gives the simulated calibration results. Note that the first row in the table corresponds to the initial conditions of the parameter set. The estimation error is calculated as the 2-norm of the difference between the actual deviations and the estimated deviations. To determine the resulting error improvement, the position error and the orientation error were computed as the root mean square error with random 100 poses in the workspace.

Platform joint locationsBase joint locationsoffset lengths
paix paiy paiz bix biy biz L0i
10.5570.05200.7380.94501.830
2-0.2330.50800.4491.11201.830
3-0.3230.4560-1.1880.16601.830
4-0.323-0.4560-1.188-0.16601.830
5-0.233-0.50800.449-1.11201.830
60.557-0.05200.738-0.94501.830

Table 1

Nominal structural parameters of the parallel robot (Unit: m)

min (m or rad)max (m or rad)
x-0.250.25
y-0.250.25
z-0.20.2
roll-0.17450.1745
pitch-0.17450.1745
yaw-0.17450.1745

Table 2

Workspace of the parallel robot

SetNoise
(mm)
Estimation
Error
Position
Error
Orientation
Error
RMS
(mm)
Reduct
%
RMS
(mm)
Reduct
%
RMS
(deg)
Reduct
%
1-0.0853-0.3060-0.0177-
0.00010.013684%0.030690%0.001989%
0.0010.038455%0.156149%0.005867%
0.010.067421%0.247919%0.009248%
0.10.076810%0.28158%0.013822%
2-0.3137-1.1730-0.0746-
0.00010.015795%0.046996%0.003795%
0.0010.056582%0.152587%0.015779%
0.010.172545%0.445762%0.041844%
0.10.251020%0.891524%0.06799%
3-1.0019-1.6196-0.1246-
0.00010.023097.7%0.047097.1%0.003197.5%
0.0010.090291%0.064896%0.003797%
0.010.250575%0.275383%0.016287%
0.10.410859%0.793651%0.041167%

Table 3

Calibration simulation results

The reduction of the parameter estimation error by itself is not the goal of the calibration. Ultimately, the resulting errors of the parallel robot should be reduced. Fig.4 shows that by estimating the model parameters well, the overall accuracy of the parallel robot can be improved. This verifies that better parameter estimates will result in improved pose accuracy. Simply by updating the nominal parameter values stored in the controller with those estimated by the calibration, the resulting accuracy of the parallel robot can be increased. The plot shows good correlation between the parameter estimation error reduction percentage and the average workspace error reduction percentage.

Fig. 5 depicts the calibration of parameter set 3 with measurement corrupted by noise of 0.01mm. The parameter estimation error is reduced by 75%. Position error RMS was reduced from 1.6196 mm to 0.2753 mm, a reduction of 83%, and orientation error RMS was reduced from 0.1246 deg to 0.0162 deg, approximately 87%. Fig. 5 show representative pose errors before and after calibration.

media/image31.png

Figure 4.

The relation of identification error reduction percentage and pose error reduction percentage

B. Experimental Results

For identification of the parameter errors of (18) a set of 50 measurement points was acquired, which is about uniformly distributed within the workspace. Within 5 iterations and 30 seconds calculation time the LS-method has identified the geometrical parameter set using the normal parameter set given in Table 1 as an initial guess.

The improvement in quantitative terms is given by the mean error and the standard deviation in Table 4.

By calibration and full pose measurement the position error improved by a factor of 2.7 for the mean value and by a factor of 4.3 for the standard deviation. For the chosen size of the parallel robot this corresponds to an absolute quantitative improve of 3.3 to 1.2 millimetres for the mean value, whereas the standard deviation drops from 0.5 to 0.1 millimetres.

By calibration an accuracy improvement a factor 3.9 for the orientation error could be obtained on the mean value whereas the standard deviation decreases by a factor of 4.7. This corresponds to an absolute improvement of 1.5 to 0.3 degrees for the mean value and 0.33 to 0.07 degrees for the standard deviation.

media/image32.png

Figure 5.

The comparison of pose error before and after calibration

position error (unit: mm)orientation error (unit: degree)
Δx Δy Δz |(Δx, Δy, Δz)| Δθx Δθy Δθz |(Δθx , Δθy , Δθz)|
before calibrationmean2.19-3.45-0.843.250.14-0.680.471.52
standard deviation0.420.860.290.470.360.180.490.33
after calibrationmean0.810.18-0.571.200.080.030.030.39
standard deviation0.140.330.090.110.010.060.010.07

Table 4

Position and Orientation Error of the Parallel Robot before and after Calibration

5. Conclusions

A new kinematic calibration method for docking mechanism motion simulator was presented, using a coordinate measuring machine that made constraint conditions. Calibration equation was established to perform calibration with the proposed method. These measurement data were used to identify the parameters of the calibration equation resulting in an accuracy improvement of RMS (root mean squares errors) a factor of 2.7 for the position and a factor of 3.9 for the orientation.

References

1 - D. Stewart, A platform with six degrees of freedom, Proc. Of Inst. Mech. Engr., vol. 180, no. 1, pp. 371-386, 1965.
2 - Z. S. Roth, B. W. Mooring, and B. Ravani, An overview of robot calibration, IEEE Transactions on Robotics and Automation, vol. 3, pp. 377-385, 1987.
3 - J. M. Hollerbach, A survey of kinematic calibration, the Robotics Review 1, MIT press, Cambridge, MA, pp. 207-242, 1989.
4 - C. Innocenti, Algorithms for kinematic calibration of full-parallel manipulators, Proc. Of Computational Kinematics’ 95, Kluwer Academic, Boston, pp. 241-250, 1995.
5 - B. W. Mooring, Z. S. Roth, and M. R. Driels, Fundamentals of manipulator calibration, John Wiley & Sons, New York, pp. 18-21, 1991.
6 - C. Wampler and T. Arai, Calibration of robots having kinematic closed-loops using nonlinear least squares estimator, IFToMM, pp. 153-158, 1992.
7 - H. Zhuang, self-calibration of parallel mechanisms with a case study on stewart platform, IEEE Transactions on Robotics and Automation, vol. 13, pp. 387-397, 1997.
8 - L. Baron, Contributions to the estimation of rigid-body motion under sensor redundancy, PhD thesis, CIM, McGill University, 1997.
9 - D.J. Bennett and J. M. Hollerbach, Autonomous calibration of single-loop closed kinematic chains formed by manipulators with passive endpoint constraints, IEEE Transactions on Robotics and Automation, vol. 7, pp. 597-606.
10 - D. Daney, Self-calibration of gough platform using leg mobility constraints, Proc. 10th World Congress Theory Machines & Mechanism, Oulu, Finland, pp. 104-109, 1999.
11 - W. Khalil and S. Besnard, Self calibration of stewart-gough platform parallel robots without extra sensors, IEEE Transactions on Robotics and Automation, vol. 15, pp. 1116-1121, 1999.
12 - H. Zhuang and Z. S. Roth, Methods for kinematic calibration of stewart platform, Journal of Robotic Systems, vol. 10, pp. 391-405, 1993.
13 - Z. Geng and L. S. Haynes, An effective kinematics calibration method for stewart platform, Proc. Of ISRAM, pp. 87-92, 1994.
14 - O. Masory, H. Zhuang, and Y. Jiahua, Kinematic calibration of a stewart platform using pose measurements obtained by a single theodolite, Proc. Of IEEE Intell. Robots and Systems, pp. 329-334, 1995.
15 - S. Besnard and W. Khalil, Calibration of parallel robots using two inclinometers, Proc. IEEE ICRA, Detroit, USA, pp. 519-539, 1997.
16 - O. Masory, J. Wang and H. Zhuang, Kinematic modeling and calibration of a stewart platform, Advanced Robotics, vol. 11, pp. 519-539, 1997.
17 - M. P. Oloviers and J. R. R. Mayer, Global kinematic calibration of a stewart platform, ASME DSC 57, pp. 129-136, 1995.
18 - H. Zhuang, Y. Jiahua and O. Masory, Calibration of stewart platforms and other parallel manipulators by minimizing inverse kinematic residuals, Journal of Robotic Systems, vol. 15, pp. 395-405, 1998.
19 - B. Dasgupta and T.S. Mruthyunjaya, A canonical formulation of the direct position kinematics problem for a general 6-6 stewart platform, Mechanism and Machine Theory, vol. 29, pp. 819-827, 1994.
20 - J. P. Merlet, Direct kinematics of parallel manipulators, IEEE Transactions on Robotics and Automation, vol. 9, pp. 842-846, 1993.
21 - H. Zhuang and Z. S. Roth, Modeling gimbals axis misalignment and mirror center offset in a single beam laser tracking measurement system, Int. J. Robotics Research, vol. 14, pp. 211-224, 1995.
22 - H. Zhuang, K. Wang and Z. S. Roth, Simultaneous calibration of a robot and a hand-mounted camera, IEEE Transactions on Robotics and Automa tion, vol. 11, pp. 649-660, 1995.