The paper presents an algorithm for the real-time evaluation of the actual end-effector orientation of general parallel spherical wrists. Conceptually, the method relies on evidence that the pose of a rigid body is defined once the location of at least two linearly independent vectors attached to the body is known. The location of these vectors of the wrist end-effector is determined by the solution of the direct position analysis of some properly chosen kinematic chains (legs) of the manipulator. In order to accomplish this analysis, extra sensors, which measure suitable non-actuated variables of the chosen legs, need to be placed in addition to the ones normally embedded in the servomotors, i.e., the sensors which measure the actuated variables. From a mathematical point of view, the algorithm is built on the polar decomposition of a matrix and has inherent least square features. Thus, together with measurement redundancy, i.e., more sensors (extra sensors) than the mechanism degrees of freedom, the method also makes it possible to minimize the influence of both round-off and measurement errors on the estimation of the location of the wrist end-effector. The method is general but, in order to prove its effectiveness, without loss of generality it has been customized to the solution of the 3(UPS)-S fully parallel wrist architecture (where U, P and S are for universal, prismatic and spherical joint, respectively). Comparison of the proposed method, in both its general and specialized form, with others from the literature is provided.

1.
Gosselin
,
C.
,
Sefrioui
,
J.
, and
Richard
,
M. J.
, 1992, “
On the Direct Kinematics of General Spherical Three-Degree-of Freedom Parallel Manipulators
,”
ASME 22nd Biennial Mechanisms Conference
, ASME DE-45, pp.
7
11
.
2.
Gosselin
,
C.
, and
Gagné
,
M.
, 1995, “
A Closed-Form Solution for the Direct Kinematics of a Special Class of Spherical Three-Degree-of-Freedom Parallel Manipulators
,”
Computational Kinematics
, edited by
J. P.
Merlet
and
B.
Ravani
,
Kluwer
, Dordrecht, pp.
231
241
.
3.
Di Gregorio
,
R.
, 2003, “
Kinematics of the 3-UPU Wrist
,”
Mech. Mach. Theory
0094-114X,
38
, pp.
253
263
.
4.
Di Gregorio
,
R.
, 2001, “
A New Parallel Wrist Using Only Revolute Pairs: The 3-RUU Wrist
,”
Robotica
0263-5747,
19
, pp.
305
309
.
5.
Gosselin
,
C. M.
,
Sefrioui
,
J.
, and
Richard
,
M. J.
, 1992, “
On the Direct Kinematics of a Class of Spherical Three-Degree-of-Freedom Parallel Manipulators
,”
ASME Proceedings of the 22nd Biennial Mechanism Conference
, ASME DE-45, pp.
13
19
.
6.
Husain
,
M.
, and
Waldron
,
K. J.
, 1992, “
Direct Position Analysis of the 3-1-1-1 Stewart Platform
,”
ASME Proceedings of the 22nd Biennial Mechanism Conference
, ASME DE-45, pp.
89
97
.
7.
Innocenti
,
C.
, and
Parenti-Castelli
,
V.
, 1993, “
Echelon Form Solution of Direct Kinematics for the General Fully-Parallel Spherical Wrist
,”
Mech. Mach. Theory
0094-114X,
28
, pp.
553
561
.
8.
Wohlhart
,
K.
, 1994, “
Displacement Analysis of the General Spherical Stewart Platform
,”
Mech. Mach. Theory
0094-114X,
29
, pp.
581
589
.
9.
Huynh
,
P.
, and
Herve
,
J. M.
, 2005, “
Equivalent Kinematic Chains of Three Degree-of-Freedom Tripod Mechanisms With Planar-Spherical Bonds
,”
J. Mech. Des.
1050-0472,
127
, pp.
95
.
10.
Di Gregorio
,
R.
, 2004, “
The 3-RRS Wrist: A New, Simple and Non-Overconstrained Spherical Parallel Manipulator
,”
J. Mech. Des.
1050-0472,
127
, pp.
850
.
11.
Merlet
,
J. P.
, 2000,
Parallel Robots
,
Kluwer Academic
, Dordrecht.
12.
Zhang
,
Y.
,
Crane
,
C.
, and
Duffy
,
J.
, 1998, “
Determination of the Unique Orientation of Two Bodies Connected by a Ball-And-Socket Joint From Four Measured Displacements
,”
J. Rob. Syst.
0741-2223,
15
, pp.
299
308
.
13.
Parenti-Castelli
,
V.
, and
Di Gregorio
,
R.
, 2001, “
Real-Time Actual Pose Determination of the General Fully Parallel Spherical Wrist, Using Only One Extra Sensor
,”
J. Rob. Syst.
0741-2223,
18
, pp.
723
729
.
14.
Golub
,
G. H.
, and
Van Loan
,
C. F.
, 1983,
Matrix Computation
,
The Johns Hopkins University Press
, Baltimore, MD.
15.
Higham
,
N. J.
, 1986, “
Computing the Polar Decomposition With Applications
,”
SIAM (Soc. Ind. Appl. Math.) J. Sci. Stat. Comput.
0196-5204,
7
, pp.
1160
1175
.
16.
Bèlanger
,
P. R.
,
Dobrovolny
,
P.
,
Helmy
,
A.
, and
Zhang
,
X.
, 1998, “
Estimation of Angular Velocity and Acceleration From Shaft-Encoder Measurements
,”
Int. J. Robot. Res.
0278-3649,
17
, pp.
1225
1233
.
17.
Baron
,
L.
, and
Angeles
,
J.
, 2000, “
The Kinematic Decoupling of Parallel Manipulators Using Joint-Sensor Data
,”
IEEE Trans. Rob. Autom.
1042-296X,
16
.
18.
Dubrulle
,
A. A.
, 1999, “
An Optimum Iteration for the Matrix Polar Decomposition
,”
Electron. Trans. Numer. Anal.
1097-4067,
8
, pp.
21
25
.
19.
Vertechy
,
R.
, and
Parenti-Castelli
,
V.
, 2005, “
An Accurate and Fast Algorithm for the Determination of the Rigid Body Pose by Three Point Position Data
,”
International Workshop on Computational Kinematics
, CK2005,
Cassino
, Italy.
You do not currently have access to this content.