an efficient approach to the forward kinematics of a planar parallel manipulator with similar...
TRANSCRIPT
IEEE TRANSACTIONS ON ROBOTICS AND AUTOMATION, VOL. 18, NO. 4, AUGUST 2002 647
[8] Z. Hu, S. E. Salcudean, and P. D. Loewen, “Robust controller design forteleoperation systems,” inProc. IEEE Int. Conf. Systems, Man, Cyber-netics, vol. 3, Vancouver, BC, Canada, Oct. 1995, pp. 2127–2132.
[9] R. J. Adams and B. Hannaford, “Stable haptic interaction with virtualenvironments,”IEEE Trans. Robot. Automat., vol. 15, pp. 465–474, June1999.
[10] H. Kazerooni, T.-I. Tsay, and K. Hollerbach, “A controller design frame-work for telerobotic systems,”IEEE Trans. Contr. Syst. Technol., vol. 1,pp. 50–62, Mar. 1993.
[11] J. Yan and S. E. Salcudean, “Teleoperation controller design usingH-infinity optimization with application to motion-scaling,”IEEETrans. Contr. Syst. Technol., vol. 4, pp. 244–258, May 1996.
[12] G. M. H. Leung, B. A. Francis, and J. Apkarian, “Bilateral controllerfor teleoperators with time delay via mu-synthesis,”IEEE Trans. Robot.Automat., vol. 11, pp. 105–116, Feb. 1995.
[13] B. Hannaford, “A design framework for teleoperators with kinestheticfeedback,”IEEE Trans. Robot. Automat., vol. 5, pp. 426–434, Aug.1989.
[14] N. Dhruv and F. Tendick, “Frequency dependence of compliancecontrast detection,” inProc. Symp. Haptic Interfaces for VirtualEnvironment and Teleoperator Syst., ASME Int. Mech. Eng. Congr.Expo. (IMECE 2000), vol. DSC 69-2, Orlando, FL, Nov. 2000, pp.1087–1093.
[15] K. Zhou, J. C. Doyle, and K. Glover,Robust and Optimal Con-trol. Englewood Cliffs, NJ: Prentice-Hall, 1996.
[16] B. Hannaford, “Stability and performance tradeoffs in bi-lateral telema-nipulation,” in Proc. IEEE Int. Conf. Robotics Automation, Scottsdale,AZ, 1989, pp. 1764–1767.
[17] A. Sherman, M. C. Çavus¸oglu, and F. Tendick, “Comparison of teleop-erator control architectures for palpation task,” inProc. ASME DynamicSyst. Control Div., ASME Int. Mech. Eng. Congr. Expo. (IMECE 2000),vol. 2, Orlando, FL, Nov. 2000, pp. 1261–1268.
[18] P. Buttolo, “Characterization of Human Pen Grasp With Haptic Dis-plays,” Ph.D. dissertation, Dept. Elect. Eng., Univ. Washington, 1996.
[19] A. Z. Hajian and R. D. Howe, “Identification of the mechanicalimpedance at the human finger tip,”J. Biomech. Eng., vol. 119, pp.109–114, Feb. 1997.
[20] M. C. Çavusoglu, J. Yan, and S. S. Sastry, “A hybrid system approachto contact stability and force control in robotic manipulators,” inProc.12th IEEE Int. Symp. Intelligent Control (ISIC’97), Istanbul, Turkey,July 1997, pp. 143–148.
[21] B. Hannaford and J.-H. Ryu, “Time domain passivity control of hapticinterfaces,” inProc. IEEE Int. Conf. Robotics Automation, vol. 2, 2001,pp. 1863–1869.
[22] H. Das, H. Zak, W. S. Kim, A. K. Bejczy, and P. S. Schenker, “Oper-ator performace with alternative manual control modes in teleoperation,”Presence, vol. 1, no. 2, pp. 201–218, Spring 1992.
[23] W. S. Kim, B. Hannaford, and A. K. Bejczy, “Force-reflection and sharedcompliant control in operating telemanipulators with time delay,”IEEETrans. Robot. Automat., vol. 8, pp. 176–185, Apr. 1992.
[24] B. Hannaford, L. Wood, D. A. McAffee, and H. Zak, “Performanceevaluation of a six-axis generalized force-reflecting teleoperator,”IEEETrans. Syst., Man, Cybern., vol. 21, pp. 620–633, May/June 1991.
[25] C. A. Lawn and B. Hannaford, “Performance testing of passive commu-nication and control in teleoperation with time delay,” inProc. IEEE Int.Conf. Robotics Automation, Atlanta, GA, 1993, pp. 776–783.
An Efficient Approach to the Forward Kinematics of aPlanar Parallel Manipulator With Similar Platforms
Ping Ji and Hongtao Wu
Abstract—The forward kinematics of a parallel manipulator is so diffi-cult that the analytical solutions of only a few parallel manipulators havebeen found. The forward kinematics of a three-degree-of-freedom planarparallel manipulator, where the base and the mobile platforms are two sim-ilar triangles, is studied in this paper and its analytical solution is provided.The final solution is two independent univariate quadratic equations. Aswell, the forward kinematics solution is simplified to the parallel manipu-lator where the two triangles are equilateral and a numerical example ispresented.
Index Terms—Analytical solution, forward kinematics, parallel manipu-lator.
I. INTRODUCTION
A three-degree-of-freedom (DOF) planar parallel manipulator, ingeneral, consists of two triangles in a plane, as shown in Fig. 1. Themoving triangle�A1A2A3 is the mobile platform while three fixedpoints,B1, B2, andB3, form another triangle�B1B2B3, that is, thebase platform. An extensible limbLk links the couple verticesAk andBk (k = 1; 2; 3). The mobile platform can rotate and move in theplane if the limbs change their lengths with actuators, either prismatic[1]–[3] or revolute [2]. This manipulator was first proposed by Gosselinand Merlet [4] and discussed by some researchers, including [1]–[10].This paper only discusses the manipulator with prismatic actuators,called the RPR chains (R: revolute, P: prismatic) [5], [6]. Obviously,the parallel manipulator has three DOF. The forward kinematics tothis manipulator is to find the position and orientation of the mobileplatform with respect to the fixed base platform with the known limblengths.
This manipulator seems to have a very simple structure. However, itsforward kinematics is quite complicated. The result of its forward kine-matics is a univariate sixth polynomial [2], so it has to be solved numer-ically. Consequently, its forward kinematics has at most six solutions.The singularity problem of this parallel manipulator was discussed byCollins and McCarthy [7]. A special case of the manipulator, where twotriangles are equilateral, has been studied more deeply due to its sym-metry [8]–[10]. The purpose of this paper is to present an analyticalsolution to the forward kinematics of the planar parallel manipulatorwith two equilateral triangles. The two triangles of the manipulator tobe studied in this paper are only required to be similar, not necessarilyequilateral. Certainly, the result obtained here can be applied to theequilateral-triangular manipulator, since it is a special case of the sim-ilar triangular manipulators. This paper discusses the manipulator withtwo similar platforms in plane, as shown in Fig. 1, while the general-ization of this manipulator, that is, the manipulator with two similarplatforms in space, has been discussed by some researchers, including[11].
Manuscript received May 18, 2001; revised November 28, 2001. This paperwas recommended for publication by Associate Editor C. Gosselin and EditorI. Walker upon evaluation of the reviewers’ comments. This work was supportedby The Hong Kong Polytechnic University under Project G-T056.
P. Ji is with the Department of Industrial and Systems Engineering, TheHong Kong Polytechnic University, Hung Hom, Kowloon, Hong Kong (e-mail:[email protected]).
H. Wu is with the Department of Mechanical Engineering, Nanjing Universityof Aeronautics and Astronautics, Jiangsu 210016, P. R. China.
Digital Object Identifier 10.1109/TRA.2002.802208
1042-296X/02$17.00 © 2002 IEEE
648 IEEE TRANSACTIONS ON ROBOTICS AND AUTOMATION, VOL. 18, NO. 4, AUGUST 2002
Fig. 1. Three-DOF planar parallel manipulator.
II. THREE-DOF PLANAR PARALLEL MANIPULATOR
Three points form a triangle if they are not in a line, so the radius ofthe circumcircle formed by pointsB1,B2, andB3 is defined asrb andthe circumcenterO is the origin of the fixed frameOXY. Since theY axis is set up through pointB2, without loss of generality, the threepoints can be denoted as
B1 =(b1x; b1y)T (1a)
B2 =(b2x; b2y)T = (0; rb)
T (1b)
B3 =(b3x; b3y)T (1c)
and their unit vectors are
B1 =B1
rb= b1x; b1y
T(2a)
B2 =B2
rb= (0; 1)T (2b)
B3 =B3
rb= b3x; b3y
T(2c)
or
Bk =rbBk (k = 1; 2; 3): (2d)
Similarly, the mobile frame is set up at the cirmcumcenterO0 ofpointsA1, A2, andA3 while theY 0 axis goes through pointA2. Thecircumradius is defined asra, then
A1 =(a1x; a1y)T (3a)
A2 =(a2x; a2y)T = (0; ra)
T (3b)
A3 =(a3x; a3y)T (3c)
and
A1 =A1
ra(4a)
A2 =A2
ra= (0; 1)T (4b)
A3 =A3
ra(4c)
or
Ak =rbAk (k = 1; 2; 3): (4d)
Obviously, the following equation exists:
Ak = Bk (k = 1; 2; 3) (5)
Therefore
AT
kBk = BT
kBk = 1 (k = 1; 2; 3): (6)
If P = (px; py)T is the position vector between the two origin points
O andO0,R is the transformation matrix between the two frames, andhere
R =cos � � sin �
sin � cos �
by (5), we have
AT
kRBk = BT
kRBk = cos � (k = 1; 2; 3): (7)
Now the limb vectors can be represented as
Lk = P+RAk �Bk (k = 1; 2; 3): (8)
Due to (2d), (4d), and (5)
Lk = P+ (raR� rbE)Bk (k = 1; 2; 3) (9)
whereE is a 2� 2 identity matrix. So, the length of each limb can beobtained as follows:
L2
k = P+ (raR� rbE)BkTP+ (raR� rbE)Bk
(k =1; 2; 3): (10)
Due to (6) and (7), (10) can be rewritten as
L2
k =PTP+ 2B
T
k raRT� rbE P+ r
2
a + r2
b � 2rarb cos �
(k =1; 2; 3): (11)
If P and� are known, the lengthLk(k = 1; 2; 3) of each limb canbe obtained easily from (11) and this is the inverse kinematics of themanipulator.
III. A NALYTICAL SOLUTION
In the forward kinematics, the three limb lengthsLk(k = 1; 2; 3) in(11) are given, whileP and� are unknown. Thus, (11) is a set of threenonlinear equations with three unknowns. By defining
W = (wx; wy)T = raR
T� rbE P (12)
then (11) can be expanded as
PTP+ 2B
T
1W =L2
1 � r2
a + r2
b + 2rarb cos � (13a)
PTP+ 2B
T
2W =L2
2 � r2
a + r2
b + 2rarb cos � (13b)
PTP+ 2B
T
3W =L2
3 � r2
a + r2
b + 2rarb cos �: (13c)
Obviously, we have
2 BT
1 �BT
2 W =L2
1 � L2
2 (14a)
2 BT
3 �BT
2 W =L2
3 � L2
2: (14b)
That is
b1x b1y � 1
b3x b3y � 1
wx
wy
=
(L �L )2
(L �L )2
: (15)
Therefore
wx
wy
=b1x b1y � 1
b3x b3y � 1
�1 (L �L )2
(L �L )2
: (16)
In order to get�, let
�2 = r
2
a + r2
b � 2rarb cos �: (17)
Here,�, ra, andrb form a triangle and, obviously,� � 0. From (12),we have
wx
wy
=ra cos � � rb ra sin �
�ra sin � ra cos � � rb
px
py: (18)
IEEE TRANSACTIONS ON ROBOTICS AND AUTOMATION, VOL. 18, NO. 4, AUGUST 2002 649
Therefore
px
py=
1
�2ra cos � � rb �ra sin �
ra sin � ra cos � � rb
wx
wy
: (19)
Also, by (19), we have
PTP = p
2
x + p2
y =w2
x + w2
y
�2: (20)
Now (13b) becomes
w2
x + w2
y
�2+ 2wy = L
2
2 � �2: (21)
Equation (21) is a quadratic equation in terms of�2 and its solution is
�2=
L2
2
2� wy � L4
2
4� wyL
2
2� w2
x: (22)
So far, we have solved the forward kinematics problem of thismanipulator. The procedure is to getwx, wy first by use of (16), thento get�2 from (22) and� from (17), and finally to obtainpx, py from(19). Equation (22) may yield two real solutions of�2 and each ofthem leads two�’s, so there are at most four solutions to the forwardkinematics of the parallel manipulator.
The advantage of this method is obvious. Equation (22) is aunivariate quadratic equation and (17) can be considered as anotherunivariate quadratic equation, so only two independent univariatequadratic equations are required to solve and, certainly, the manip-ulator has an analytical solution to its forward kinematics withoutnumerical iterations. Recently, Kong and Gosselin [5] also obtainedan analytical solution to the forward kinematics of this manipulator.Compared with their solution procedure, the approach presented inthis paper is more elegant and concise.
The general three-DOF planar parallel manipulator has at most sixsolutions to its forward kinematics [2]. However, as we derived ear-lier, the special three-DOF planar parallel manipulator with two sim-ilar triangles has at most four solutions to its forward kinematics. If thesolution procedure [2] for the general planar parallel manipulator, thatis, the case where the two platforms are not similar, is applied to thismanipulator with two similar platforms, it can be proved that the othertwo solutions are extraneous. They are
T2= � ra � rb
ra + rb
2
whereT is defined as
cos � =1� T 2
1 + T 2and sin � =
2T
1 + T 2:
IV. EXAMPLE
Since the three-DOF planar parallel manipulator with two equilateraltriangles has been investigated deeply, a numerical example is providedhere for this type of manipulators. Before the example is presented, theprevious solution is simplified for this equilateral triangle case. Due toequilateral triangles, we have
B1 =B1
rb= b1x; b1y
T=
p3
2;�1
2
T
B3 =B3
rb= b3x; b3y
T= �
p3
2;�1
2
T
:
Thus, from (16), we have
wx =L2
1 � L2
3
2p3
(23)
wy =2L2
2 � L2
1 � L2
3
6: (24)
TABLE IFINAL SOLUTIONS
Now (22) becomes
�2
=L2
1 + L2
2 + L2
3
6� 2L2
1L2
2+ 2L2
1L2
3+ 2L2
2L2
3� L4
1� L4
2� L4
3
12:
(25)
Suppose the parameters of the manipulator arera=30 andrb=40.If px = 12, py = 8, and� = 40
�, then from (11) we can obtainL1 =
33:919134, L2=11:592566, andL3=36:380912.Now, if the aboveL1, L2, andL3 are known, in order to getpx, py,
and�, we can getwx=�49:9550 andwy=�367:5529 from (23) and(24), and�21=661:4933 and�22=208:0 from (25). The four solutionsto the forward kinematics are listed in Table I.
V. CONCLUSION
The forward kinematics of the three-DOF planar parallelmanipulator with two similar triangles was studied in this paper andits analytical solution with only two independent univariate quadraticequations was presented. One of its special cases, where the twotriangles are both equilateral, was also discussed and its simplifiedsolution was provided.
REFERENCES
[1] C. M. Gosselin, S. Lemieux, and J.-P. Merlet, “A new architecture ofplanar three-degree-of-freedom parallel manipulator,” inProc. IEEEInt. Conf. Robotics and Automation, Minneapolis, MN, 1996, pp.3738–3743.
[2] C. M. Gosselin and J. Sefrioui, “Polynomial solution for the directkinematic problem of planar three-degree-of-freedom parallel manipu-lators,” in Proc. IEEE Int. Conf. Robotics and Automation, Pisa, Italy,1991, pp. 1124–1129.
[3] H. R. M. Daniali, P. J. Zsombor-Murry, and J. Angeles, “The kinematicsof 3 DOF planar and spherical double-triangular parallel manipulators,”in Computational Kinematics, J. Angeles, Ed. Dordrecht, The Nether-lands: Kluwer, 1993, pp. 153–164.
[4] C. M. Gosselin and J. P. Merlet, “The direct kinematics of planar parallelmanipulators: Special architectures and number of solutions,”Mech.Machine Theory, vol. 29, no. 8, pp. 1083–1097, 1994.
[5] X. Kong and C. M. Gosselin, “Determination of the uniqueness domainsof 3-RPR parallel manipulators with similar platforms,” inProc. ASME26th Biennial Mechanisms and Robotics Conf., Baltimore, MD, Sept.2000, paper DETC2000/MECH-14094.
[6] C. L. Collins, “Classification and forward kinematics of planar parallelmanipulators,” inProc. Int. Workshop Parallel Kinematic Machines(PKM99), Milan, Italy, Nov. 1999.
[7] C. L. Collins and J. M. McCarthy, “The quartic singularity surfaces ofplanar platforms in the Clifford algebra of the projective plane,”Mech.Machine Theory, vol. 33, no. 7, pp. 931–944, 1998.
[8] X.-J. Liu, J.-S. Wang, and F. Gao, “On the optimum design of planar3-DOF parallel manipulators with respect to the workspace,” inProc.IEEE Int. Conf. Robotics and Automation, San Francisco, CA, 2000, pp.4122–4127.
[9] C. Gosselin and J. Angeles, “The optimum kinematic design of a planarthree-degree-of-freedom parallel manipulator,”J. Mech., Transmis., Au-tomat. Des., vol. 110, no. 1, pp. 35–41, 1988.
[10] L.-W. Tsai,Robot Analysis. New York: Wiley, 1999.[11] H.-Y. Lee and B. Roth, “A closed-form solution of the forward displace-
ment analysis of a class of in-parallel mechanisms,” inProc. IEEE Int.Conf. Robotics and Automation, Atlanta, GA, May 1993, pp. 720–724.