0 Voturi pozitive0 Voturi negative

4 (de) vizualizări7 paginiJul 14, 2018

© © All Rights Reserved

PDF, TXT sau citiți online pe Scribd

© All Rights Reserved

4 (de) vizualizări

© All Rights Reserved

- Magnetometer Offset Nulling
- Iran-National Math Olympiad 3rd Round-1998-101
- [Yuan]ClosedLoopManipulatorUsingQuaternionFeedback.pdf
- slaa518a.pdf
- CFD Analysis
- fghfgh
- Tutorial_02_Creating_a_Dips_File.pdf
- MR 2.pptx
- Matlab Intro
- Readme
- Complete Career Path Guide
- Opengl Introduction
- 339
- GEOS1050 3D geology
- Sf 9dof Razor Ahrs
- Uses of Matrices in Daily Life
- Engineering Mathematics1
- J26
- MatlabOutline.pdf
- FreeForm 3Axis 5Axis Essentials.pptx

Sunteți pe pagina 1din 7

AUGUST 1988

R. B. McGhee et al. “Real-time computer control of a hexapod second one is based on a Euler rotation representation. The quaternion

vehicle,” in Proc 3rd CISM-IFToMM Symp. on Theory and vector approach leads to a linear feedback control law for which the

Practice of Robots and Manipulators. Amsterdam, The Nether- global asymptotic convergence of the orientation error is readily estab-

lands: Elsevier, pp. 323-339, 1978. lished. The Euler rotation approach also results in asymptotic error

R. B. McGhee and G. I. Iswandhi, “Adaptive locomotion of a convergence in the large except for a singularity where the hand

multilegged robot over rough terrain,” IEEE Trans. Sysr. Man

orientation differs from its desired orientation by a rotation of 180”.

Cybern., vol. SMC-9, no. 4, pp. 176-182, 1979.

M. H. Raibert and I. E. Sutherland, “Machines that walk,” Scientific I. INTRODUCTION

Amer., vol. 248, no. I , pp. 44-53. 1983.

M. H. Raibert and F. C. Wimberly, “Tabular control of balance in a Manipulators with six o r more degrees of freedom are generally

dynamic legged system,” IEEE Trans. Syst. Man Cybern., vol. required to follow preplanned paths of hand position and orientation

SMC-14, no. 3, 1984. defined as a function of time in Cartesian (or task space) coordinates.

M. H. Raibert et al., “Dynamically stable legged locomotion,” For closed-loop control of resolved motion, the instantaneous motion

Carnegie-Mellon Univ., Robotics Inst., Third Annual Report, Tech. of the hand, o r end-effector, must be monitored continuously either

Rep. CMU-RI-TR-83, 1983. by using direct endpoint sensing techniques (e.g., [ I ] ) o r via a

M. H. Raibert et al., “Experiments in balance with a 3D one-legged

kinematic model of the manipulator which computes the hand

hopping machine,” Int. J. Robotics Res., vol. 3, no. 2 , pp. 75-92,

1984. position and orientation from the joint variables. This information is,

D. M. Wilson, “Insect walking,” Annu. Rev. Entymol., vol. 11, pp. in turn, used to produce corrective control action from the joint

103-121, 1966. actuators in the manipulator (Fig. I ) .

S . Hirose, “A study of design and control of a quadruped walking The hand position and orientation of a manipulator are typically

vehicle,” Int. J. Robotics Res., vol. 3, no. 2, pp. 113-133, 1984. represented by the position vector and rotation matrix, respectively,

H. Hemani and R. L. Farnsworth, “Postural and gait stability of a between reference coordinate frames fixed to the base and the last

planar five link biped by simulation,” IEEE Trans. Automat. Contr., link of the manipulator [2]. The rotation matrix has the general form

vol. AC-22, pp. 452-458, 1977.

D.E. Orin, “Interactive control of six-legged vehicle with optimization &fj= In s a]

of both stability and energy,” Ph.D. dissertation, The Ohio State

Univ., Columbus, 1976. where n , s, and a are the normal, slide, and approach (unit) vectors

“Supervisory control of a multilegged robot,’’ Int. J. Robotic

of the hand frame expressed in base frame coordinates.

Res., vol. no. I , pp. 79-91, 1982.

S. S . Sun, “A theoretical study of gaits for legged locomotion It is clear that the position vector p and its derivatives ( j and

systems,” Ph.D. dissertation, The Ohio State Univ., Columbus, 1974. for velocity and acceleration, respectively) completely describe the

A. P. Bessonov and N. V. Umnov, “The analysis of gaits in six-legged translational motion of the hand. The position tracking error may be

vehicles according to their static stability,” in Proc. Symp. on Theory defined as

and Practice of Robots and Manipulators (Udine, Italy, 1973).

F. Ozguner, S . J . Tsai, and R. B. McGhee, “An approach to the use of e, = p -Pd (2)

terrain-preview information in rough-terrain locomotion by a hexapod

walking machine,” Int. J. Robotics Res., vol. 3, no. 2, pp. 134-146, where P d denote the desired hand position vector. The velocity and

1984. acceleration errors can be defined accordingly as e, (j and

E. I . Kugusheve and V. S . Jaroshevskij, “Problems of selecting a gait e,= ( p respectively.

for an integrated locomotion robot,” paper presented at the 4th Int. If o and G denote the angular velocity and acceleration of the hand,

Conf. on Artificial Intelligence, Tbilisi, Georgian SSR, USSR, 1975.

K. Ikeda et al., “Finite state control of quadruped walking vehicle- then the corresponding error terms may be defined as eo

Control by hydraulic digital actuator” (in Japanese), Biomechanisrn, and e o = (G where and denote the desired angular

vol. 2, pp. 164172, 1973. velocity and angular acceleration, respectively, of the hand. The

T. T. Lee and C. L. Shy, “A study of the gait control of quadruped question that arises now is: What is an appropriate counterpart for p

walking vehicle,” IEEE J. Robotics Automat., vol. RA-2, no. 2 , pp. which represents o dt in the following definition of orientation

61-69, 1986. tracking error?

S . M. Song, “Kinematic optimal design of a six-legged walking

machine,” Ph.D. dissertation, The Ohio State University, Columbus,

1984.

T. T. Lee and C. M. Liao, “On the hexapod crab walking tripod This question takes on particular significance in the context of closed-

gaits,” in Proc. 15th Int. Symp. on Industrial Robots (Tokyo, loop manipulator control since the position and orientation errors of

Japan, 1985), vol. pp. 263-270. the hand are used explicitly in the feedback loop.

When the manipulator is controlled in its joint coordinates 13, ch.

71, there is no need to generate the hand orientation error as in (3)

since the desired traiectorv. reDresented by the hand position and

. , d .

Closed-Loop Manipulator Control Using Quaternion rotation matrix, may be converted directiy into a corresponding

Feedback trajectory in the joint coordinates. The inverse kinematic models used

for such a conversion, however, are typically very complex and exist

JOSEPH S.-C. YUAN as closed-form solutions only for manipulators with special configu-

rations, such as parallel adjacent joints o r spherical wrists [3, ch. 31.

Abstract-Euler parameters, a form of normalized quaternions, are

For orientation error feedback, the rotation matrix representation

used here to model the hand orientation errors in resolved rate and

of is clearly impractical simply because there are too many

resolved acceleration control of manipulators. The quaternion formula-

elements in the matrix. More importantly, not all of its elements

tion greatly simplifies stability analysis of the orientation error

(which are direction cosines) are independent due to the requirement

dynamics. Two types of quaternion feedback have been considered. The

of orthogonality among the unit vectors n, s, and a.

first type uses only the vector portion of the quaternion error, while the

Despite their nonuniqueness, Euler angles are frequently used to

represent orientation [4, ch. 2.1. I ] mainly because of their physical

Manuscript received February 26, 1987; revised October 28, 1987. manifestations, such as roll, pitch, and yaw angles. But they are

The author is with Spar Aerospace Ltd., Weston, Ont,, M ~ 2L ~ 7 , undesirable in feedback control due to singularities and computational

IEEE Log Number 8820162. complexity [3, ch. 3.21. Furthermore, because the differential

Authorized licensd use limted to: IE Xplore. Downlade on May 13,20 at 1:549 UTC from IE Xplore. Restricon aply.

IEEE JOURNAL OF ROBOTICS AND AUTOMATION. VOL. 4, NO. AUGUST 1988 435

ION

equations relating the rates of change of these angles to are highly A . Definition

nonlinear ( 4 , p. 301, it is extremely difficult to analyze the stability of Let two coordinate systems and 5 , )be separated by a rotation

the closed-loop system without using some form of small-angle linear of about a unit vector r as defined in Euler’s Theorem. Then the

approximation. quaternion description of the orientation difference between the two

Alternatively, the difference in orientation between two coordinate systems is given by a scalar and a vector q defined as follows:

systems may be expressed as a single rotation through some angle

about a fixed axis as stated in Euler’s Theorem [ 4 , p. 131. Such a = c o s (cp/2) q =sin (cp/2)r.

rotation (known as Euler rotation) represents the minimal angular

distance between the two systems. This formulation has a natural Note that if q } is the quaternion representation of relative to

appeal from the control standpoint since the rotation vector coincides To, then q } represents the orientation of relative to 51.

with the axis about which the control torque must be applied to the

hand. B. Normality

The Euler rotation representation has been used in both resolved It is clear from ( 5 ) that

rate [SI and resolved acceleration control 161. Furthermore, it has

been applied successfully to the control of the space shuttle 72+qTq= 1 (6)

manipulator In the latter case, the instantaneous error between

the actual and the desired hand orientation is described as a rotation of where a superscript “T” denotes vector o r matrix transpose.

~ ( tabout

) a unit vector r ( t ) . The angular velocity command for the C. Uniqueness

hand is then aligned with r. The feedback gain, however, must vary

continuously with the orientation error and is highly nonlinear which Both q } and q } describe the same orientation. But if

renders the stability analysis of the closed-loop system an intractable the rotation angle is confined to the range 180” 5 5

task. then the scalar is nonnegative and the quaternion representation is

It was stated in [6] that when the orientation error is small, it may unique.

be expressed in terms of the Euler rotation parameters r ) as D. Relation to Rotation Matrix

e o ( t ) sin c p ( f ) r ( t ) . (4) The direction cosine matrix describing the rotation sequence that

Unfortunately. the convergence analysis offered in [6] is based on brings 5 0 onto 5 , is given by p. 4211

linear approximation over small time intervals and does not apply to

stability in the large (i.e., when there is a large initial orientation Rlo=eos -cos cp)rr7- sin rx (7)

error). It will be shown in this communication that the Euler

.=[: I

rotation representation ( 4 ) in fact leads to convergence even for where denotes a unit matrix and

largc orientation errors.

Yet another representation for orientation is Euler parameters

rx=[ r2 (8)

which are a form of normalized quaternions [ 4 , p. 231. (For economy

in notation, the generic term “quaternion” will be used in this

communication to denote Euler parameters.) Though less amenable

It can be seen, from ( 5 ) , that the rotation matrix may also be written

to physical interpretation than either Euler angles or rotation

in terms of the quaternion parameters as

matrices, quaternions are free of singularities and are computa-

tionally more efficient. Many applications of quaternions can be

found in the literature on large-angle maneuvering and attitude

control of space vehicles [ 8 ] - [ 1 3 ] .More recently, the quaternion

formulation has been applied to the dynamic analysis of a general where the matrix q” is defined in terms of the components of q in a

class of mechanisms [ 1 4 ] , 151 which could conceivably include similar manner to r x in (8). An efficient singularity-free algorithm

manipulators. for computing the quaternion from a rotation matrix is described in

This communication extends the quaternion concept to the resolved

The quaternion vector q has the same coordinates in either 50o r

motion control of manipulators. It will be shown that the quaternion

formulation can greatly simplify the stability analysis of the orienta-

5 , . Indeed, it is the eigenvector of RI”with unit eigenvalue; that is,

tion error dynamics.

BASK PROPERTIES OF QUATERNIONS

Quaternions have many interesting properties, not all of which,

however. are relevant to the development of this communication. (A E. Quaternion Propagation

list of general identities involving quaternions can be found in [ 1 4 ] . ) Suppose the coordinate system 5 , rotates at an instantaneous

Only some of thcir fundamental features are discussed below. angular velocity of about To. Then the quaternion q } evolves in

Authorized licensd use limted to: IE Xplore. Downlade on May 13,20 at 1:549 UTC from IE Xplore. Restricon aply.

436 IEEE JOURNAL OF ROBOTICS AND AUTOMATION, VOL. 4, NO. 4, AUGUST

time according to the following differential equation [4, p. 321: Then the hand velocities are related to e by the expression [5]

[f] = J e

where is expressed in the coordinates of and the matrix is where J is a 6 Jacobian matrix whose elements are functions of

derived from in the same way r x is defined for r in (8). Further the joint variables

discussions on quaternion propagation can be found in 181.

0~17.

F. Relative Orientation

Consider two coordinate systems, and S2, and let R I Oand Rzo In open-loop resolved rate control [19], the joint rate command is

denote the rotation matrices describing the orientation of each system simply given by

referenced to a common base frame Suppose the corresponding

quaternion representations are given by { q l , and (72, 4 2 } , Bc=Jt

respectively. Then the relative orientation between SI and

denoted by the rotation matrix

where p d and are the desired linear and angular hand velocities,

RzoR (12) and J t denotes either the direct inverse (n 6) o r the generalized

inverse ( n 6) of J .

is given by (69, 64) where [9] In closed-loop control [20], however, the control law (19) is

replaced with

6~ vz :42 V I 42 9241 4 42. (13)

Note that is expressed here in the coordinates of either T I o r T2

(since they are the same), but not of

G. Orientation Error Representation where K, and KO are feedback gain matrices; e, and eo are the

If 5 , and 5 2 denote the desired and the actual hand orientation position and orientation errors of the hand defined in ( 2 ) and (3),

relative to the base of the manipulator, then (13) yields the quaternion respectively.

for the orientation error. When the two frames coincides, q 1 q2 and In most industrial robots, the command 6 , is applied directly to the

q2, wc get, through (6), rate servos at the joints. This is known as kinematic control since the

dynamics of the manipulator is completely ignored. For dynamic

control, the rate command e,, together with the measured 0 and

6q=1 6q=O. (14) estimated acceleration are used in a dynamic model of the

Conversely, at 0, manipulator (e.g., the Newton-Euler model of [21]), to compute the

joint torques. This approach is commonly known as the computed

V I 42 7241 4 42. torque method.

The computed torque algorithm of [ 2 accounts for the nonlinear

But the vectors and q i(q2are orthogonal to each other. joint inertia, Coriolis and centrifugal forces, as well as gravity. a

(The product q y q 2 is, in fact, a matrix-vector representation of the result, except for the effects of friction, actuator dynamics, and

cross product 42.) Therefore, (15) holds only if both vectors are parametric errors, the linear and angular velocities of the hand can be

zero: in other words. represented, to the first order, by the following equations:

42 (92 (16)

Furthermore through the normality condition ( 6 ) , 0 implies

f31)=q1q2+q:q2= (17) which have been obtained by applying (18) to (20). The convergence

of the position and orientation errors is thus determined by the

16) into (17) and making use of the normality of { q l , stability of the differential equations (21) and (22).

Since ep ( p p d ) and (21) is linear, it is easy to select the gain

K, so that the position error e, converges to zero asymptotically (i.e.,

e,(t) 0 as t W e shall next examine the convergence of the

both of which describe the same orientation (cf. property in orientation error in (22).

Subsection 11-C, above). Let {qdr and { q , q } denote, respectively, the quaternions for

Hence, we have established the following result which states that the desired and the actual orientation of the hand. Then each

is indeed a logical representation for the orientation error between quaternion evolves in time according to a set of differential equations

two coordinate systems: similar to 1) as follows:

0, where is the vector component of the quaternion defined in td] r:;]

(13).

Note that. unlike the case cited in [6] with the Euler rotation

representation (4), the above result holds regardless of the size of the

orientation error.

[,]=1/2 [e -:I[;]

The asymptotic stability of the nonlinear system comprising (22)-

111. CLOSED-LOOP

RESOLVEDRATECONTROI (24) is best studied by using Lyapunov's second mcthod [22]. For this

we define the following positive-definite Lyapunov function:

Lct p and be the linear and angular velocity, respectively, of the

hand of a manipulator with n links, and denote the joint rates by

e=[& 8,]7 It can be shown through substitution from (22)-(24) that the time

Authorized licensd use limted to: IE Xplore. Downlade on May 13,20 at 1:549 UTC from IE Xplore. Restricon aply.

IEEE JOURNAL OF ROBOTICS AND AUTOMATION, VOL. 4, NO. 4 , AUGUST 1988 437

NUMERICAL

DIFFERENTIATION

NEWTON FORUA9D

-EULER El ?Ut A T 0 I: 1 C

IO Q9.3T I OR

0P A C ERRORS

ROH

Fig. 2. Resolved rate control using quaternion feedback

derivative of V along any quaternion trajectory (11, is given by Substituting (30) into (26), we have

Since 611 is nonnegative (cf. property in Subsection 5 0

provided KO 0. Thus there are two equilibrium points, 611 0 and

One recognizes from (13) that the latter is simply the quaternion error 0, at which V 0. Of the two, however, only one 0)

results in true convergence of the orientation error; 0 occurs

vector between the desired and the actual hand orientation.

when the actual and the desired hand orientation are separated by a

We are now faced with the task of selecting a re,presentation for the

Euler rotation of 180".

orientation error feedback eo which will cause I/ in (26) to become

The above analysis clearly demonstrates the superiority of the

negative-definite. An obvious choice is

quaternion error feedback (28) over the Euler rotation error feedback

of (4) o r (30).

eo (28)

Iv. CLOSED-LOOP

RESOLVEDACCELERATION CONTROL

with KO 0 so that

The acceleration of the hand can be obtained by differentiating ( I 8)

(29) to yield

approach zero since it is a positive-definite functjon. This will

continue until an equilibrium point is reached where V 0, i.e., where is the time derivative of the Jacobian matrix whose elements

0. By Proposition I , this also corresponds to zero orientation e.

are functions of I9 and In resolved acceleration control [ 6 ] ,the joint

error. We therefore conclude that the quaternion error feedback given acceleration command is given by

by (28) results in global asymptotic convergence of the orientation

error.

The implementation of the quaternion error feedback (28) in

resolved rate dynamic control is illustrated in Fig. 2 . Given the

desired quaternion trajectory v d ( f ) , can be either precompu-

ted or generated on-line with (23). The instantaneous quaternion of where K,, K,, K,, and KOare feedback gain matrices. and are

the hand may be extracted from the rotation matrix ( I ) using the the desired linear and angular accelerations, and .It denotes the

singularity-free algorithm described in 171. generalized inverse of J.

Let us now study the stability of (22) with the error feedback eo e

Equation (34) together with measured values of I9 and may then

expressed as a Euler rotation. When expressed in the form of (4). the be used in a computed torque algorithm [21) to generate the joint

relationship between eo and o d ) is not obvious and it becomes torques. As a result, the linear and angular accelerations of the hand

very difficult to determine the stability of (22). The convergence are given by (see comments just above (21) and (22))

analysis given in [6] for the resolved acceleration case is valid only

for short time intervals and small orientation errors. Described below

is a stability analysis of (22) based on a quaternion formulation.

It follows from the definition of quaternions in ( 5 ) that the Euler

rotation error (4) can also be expressed as Since the linear acceleration error is given by eo (j it is

easy to choose the gain matrices K , and KO in (35) to ensure that

eo=sin r = 2 cos ((p/2) sin ((p/2)r=2676g (30) ep(t) 0 as t W e shall now analyze the convergence of the

orientation error in (36) by using a quaternion formulation.

where is given by (27) and Define the following Lyapunov function:

Authorized licensd use limted to: IE Xplore. Downlade on May 13,20 at 1:549 UTC from IE Xplore. Restricon aply.

438 IEEE JOURNAL OF ROBOTICS A N D AUTOMATION. VOL. NO. 4, AUGUST 1988

pd P

I

JOINT

TORQUE

N E ~ ~ O N COMMANDS

INVERSE FORYARO

-EULER UANIPULATOR

JACOBIAN KINEMATICS

MODEL

Ud

PROPAGATION CONVERSION

'd ,?d

Fig. 3. Resolved acceleration control using quaternion feedback.

It can be shown by substitutions from (36) and the quaternion feedback is given by a Euler rotation representation. convergence

propagation equations and that the time derivative of V analysis for this was given in 161 with the error expressed as in

along any quaternion trajectory { q , is But the results are only valid for short sampling intervals and small

orientation errors. We shall show below that even large-angle

V= 'K,(o

ad) ad) Koeo) stability can be established by using a quaternion formulation.

Substituting into we get

where the quaternion error vector is given by

To make negative-semidefinite, it is sufficient to set

Koeo (39)

Hence, provided the feedback gain matrix is set according to

and K, 0. In other words, let

Ko=I

where I is a unit matrix, is again given by (41). We, therefore.

where I is a unit matrix. W e then have

conclude that, despite what was claimed in the orientation error

'K,(w converges for large angles.

(41)

Note that, unlike the case in (40). the feedback gain KO in is

so that 5 0 for all t . In particular, whenever differs from nonlinear. This is due to the need to eliminate the second term in

V will decrease in value until an equilibrium point is reached where V so as to render V negative-semidefinite. The condition is only

0; i.e., sufficient, not necessary. By keeping constant as in however.

At o a d . we have from and (39) stability can no longer be guaranteed.

a result of the feedback gain has a singularity at 67 0

Koeo which occurs when the hand orientation diffcrs from its desired

orientation by Euler rotation of This once again demonstrates

Suppose 0 at this equilibrium point. Then, by will the superiority of the direct quaternion feedback approach over

) all t . By Proposition the hand stays aligned with

remain at o d ( ffor one using Euler rotations.

the desired orientation.

On the other hand, if adbut is nonzero, then (a ad)will V. EXPERIMENTAL

RESULTS

change according to so that can only tiold instantane- The resolved rate control law using quaternion feedback was

ously. By V becomes negative which causes I/ to decrease implemented on a Cincinnati Milacron T3-776 industrial robot. The

further toward zero. Consequently, 0 as t a,which, by main objective of the experimcnt was to demonstrate large-angle

Proposition I , corresponds to zero orientation error. Since this result stability of the two quaternion feedback formulations considered in

holds for any initial value of we have global asymptotic this communication.

convergence of the orientation error. In the experiment the hand was commanded to follow a circular

The quaternion feedback implementation of resolved acceleration path of radius mm in a vertical plane at a constant speed of

control is illustrated in Fig. As in the case of resolved rate control, mmis, while its initial orientation was displaced from the desired

the desired quaternion trajectory can be either precomputed orientation by a rotation of90" about the vertical (yaw) axis. Because

and recalled from memory o r generated on-line using the propagation this robot has very fast servo dynamics. only kinematic control was

equation The joint variables and are assumed to be implemented; that is. the command calculated from (20) was applied

measurable and the hand velocities 0 and may be calculated from directly to the inputs of the ratc servos at the joints.

Given and computed by with providing the ec Figs. and describe thc responses of the hand orientation with

orientation error feedback, the joint torques can then be calculated the feedback gain matrices set as follows:

from a Newton-Euler dynamic model of the manipulator as in

Let us now examine the stability of when the orientation error

Authorized licensd use limted to: IE Xplore. Downlade on May 13,20 at 1:549 UTC from IE Xplore. Restricon aply.

IEEE JOURNAL OF ROBOTICS AND AUTOMATION, VOL. 4, NO. 4, AUGUST 1988

30.00 30.00

TIME

i : :

t

l0:OO 30.'00 30.00

U .

TIME

30.00 30:OO

TIME

Fig. 5. Response with orientation error feedback given by 2

Authorized licensd use limted to: IE Xplore. Downlade on May 13,20 at 1:549 UTC from IE Xplore. Restricon aply.

IEEE JOURNAL OF ROBOTICS AND AUTOMATION, VOL. NO. 4, AUGUST 1988

where I is a 3 3 unit matrix. The orientation errors are presented in P. E. Nikravesh, 0. K. Kwon, and R. A. Wehage, “Euler parameters

the figures both as the Euclidean norm of and as the in computational kinematics and dynamics. Part J.

conventional Euler angles (roll, pitch, and yaw). vol. pp. Sept.

Fig. 4 corresponds to the case with direct quaternion error B. Noble, Englewood Cliffs, NJ: Prentice-

feedback eo while in Fig. 5 the error feedback was based on Hall,

S. W. Shepperd, “Quaternion from rotation matrix,” J.

Euler rotation eo 2 67 The convergence rates for the two cases vol. no. pp. May-June

are different as expected due to the different obtained in (29) and R. A. Mayo, “Relative quaternion state transition relation,” J.

(32). In particular, the results of Fig. 5 demonstrate that the Euler vol. no. pp. Jan.-Feb.

rotation representation of (4) is valid even for large orientation D. E. Whitney, “Resolved motion rate control of manipulators and

errors. human prostheses,” vol. MMS-IO,

no. 2, pp. June

VI. CONCLUSIONS C. H. Wu and R. P. Paul, “Resolved motion force control of robot

Though quaternions are composed of a scalar and a vector, the manipulator,” IEEE vol. SMC-12, no.

orientation error is adequately represented by only the vector portion pp. MayiJune

J. Y . S. Luh, M. W. Walker, and R. P. C. Paul, “On-line

of the quaternion difference between the actual and the desired hand computational scheme for mechanical manipulators,” J.

orientation. This vector quaternion error formulation greatly simpli- vol. pp. June

fies the stability analysis of the orientation error equations. W. Hahn, New York, NJ: Springer-Verlag,

Of the two types of quaternion feedback considered, the approach

using only is far more superior to that derived from a Euler

rotation representation ( 2 67 since the feedback gain is constant

and stability is globally asymptotic. The Euler rotation feedback has a

singularity when the actual hand orientation differs from its desired

orientation by 180”. In resolved rate control, this singularity Kinematics of a Robot with Continuous Roll Wrist

manifests itself as an equilibrium point with nonzero orientation

error, while in resolved acceleration control, the feedback gain KRISHNA C. GUPTA

(which is nonlinear) becomes infinitely large.

Abstract-Some

ACKNOWLEDGMENT

The author wishes to thank F. Keung for preparing the experimen-

tal results of this paper. He is also grateful for several insightful

comments from the reviewers. I. INTRODUCTION

REFERENCES In a continuous roll wrist, all of the wrist joints have unrestricted

rotational degree of freedom. The wrist axes are configured such that

J. S. Schoenwald, M. S. Black, J. F. Martin, G . A. Arnold, and T. A. there is no mechanical interference among the links of the wrist as the

Allison. “Improved robot trajectory from acoustic range servo con-

wrist variables change continuously in the ranges [O, 360”j. There

trol,” in pp.

are several ways to induce the continuous roll feature in wrists and we

C. S. G . Lee, “Robot kinematics. dynamics and control,” IEEE discuss two important ways. Let the wrist axes be labeled 2, n

vol. IS. no. pp. Dec. and (last).

R. P. Paul, In a spherical wrist (i.e., s,- a,. I a,,- 0) with

Cambridge, MA: MIT Press, serially orthogonal joint axes (i.e., a , - ~ , ~ -a,.

~ I,,l 9 0 ” ) , there

J. Wittenburg, Stuttgart, is mechanical interference when we turn about the I)th joint. If

FRG: Teubner, the angles between successive joint axes are changed such that

D. E. Whitney. “The mathematics of coordinated control of prosthetic a,-2,,-] 90” and 90” then such a

arms and manipulators,” J.

nonorthogonal spherical wrist has a continuous 3-roll property.

pp. Dec.

J. Y . S. Luh, M. W. Walker, and R. P. C. Paul, “Resolved- Kinematic solutions of robots with spherical wrists are straightfor-

acceleration control of mechanical manipulators, IEEE ward because of decoupling [5]-[7];among these, and (71

vol. AC-25, no. pp. June also discuss the solutions of a variety of other robot-arm configura-

R. Ravindran and K. H. Doetsch, “Design aspects of the shuttle remote tions.

manipulator control,” in Con$ Another way to modify the orthogonal spherical wrist is to introduce

(San Diego, CA, paper 82-1581-CP. a small amount of offset (s,-],, 0). W e then have a nonspherical

R. Mortensen, “A globally stable linear attitude regulator,” Int. J . wrist in which the axes ( n 2) and 1) intersect at one point (i.e.,

vol. 8. no. pp. a,_2,n-I 0), but the axes 1) and intersect at another point

B . P. Ickes. “A new method for performing digital control system (i.e., an-,,, O), thus causing a small offset s, 0. Angles

attitude computation using quaternions.” J . , vol. no. I , pp.

Jan. between the successive axes are CY, I a, I 90”.

B . Friedland. “Analysis strapdown navigation using quaternions,” In this communication, we use the zero reference position method

IEEE vol. AES-14, no. pp. [2] for analyzing a robot with the second type of continuous roll wrist

Sept. (nonspherical). The zero reference position method is a simple

E. C. Wong and W. G . Breckenridge, “Inertial attitude determination method for formulating robot kinematics just from the data on joint

for a dual-spin planetary spacecraft,” J. axes directions and locations in a conveniently chosen reference

vol. no. pp. Nov.-Dec.

R. B. Miller, “A new strapdown attitude algorithm,” J. Manuscript received April revised August This work

vol. pp. July-Aug. 1983. was supported by the U. S. Army Research Office under Contracts EG

B. Wie and P. Barba. “Quaternion feedback for spacecraft large and EG. Part of the material in this communication was presented at the

angle maneuvers,” J. vol. no. International Conference on Robotics and Automation, Raleigh, NC.

pp. May-June March 31-April

P. E. Nikraveah, R. A. Wehage. and 0. K. Kwon. ”Euler parameters The author is with the Department of Mechanical Engineering, University

in comuptational kinematics and dynamics. Part J. of Illinois at Chicago, Chicago, IL

vol. pp. Sept. IEEE Log Number

Authorized licensd use limted to: IE Xplore. Downlade on May 13,20 at 1:549 UTC from IE Xplore. Restricon aply.

- Magnetometer Offset NullingÎncărcat der9hino
- Iran-National Math Olympiad 3rd Round-1998-101Încărcat deBiswarup Burman
- [Yuan]ClosedLoopManipulatorUsingQuaternionFeedback.pdfÎncărcat dedrymon_159
- slaa518a.pdfÎncărcat debozzaitabob4493
- CFD AnalysisÎncărcat deAnonymous EPSHB9tXZ
- fghfghÎncărcat deMuhammad Yasar Javaid
- Tutorial_02_Creating_a_Dips_File.pdfÎncărcat deReinel Cruz Pacsi
- MR 2.pptxÎncărcat deKarthikeyanRamanujam
- Matlab IntroÎncărcat deRaju Reddy
- ReadmeÎncărcat deSonu Ratan
- Complete Career Path GuideÎncărcat deZulhafizan Zulkifli
- Opengl IntroductionÎncărcat deorchid21
- 339Încărcat deSSSUUPP
- GEOS1050 3D geologyÎncărcat deEmma Buxton
- Sf 9dof Razor AhrsÎncărcat deAnanda Everingham
- Uses of Matrices in Daily LifeÎncărcat dejinil shah
- Engineering Mathematics1Încărcat debkpooja03
- J26Încărcat deShadvala Sebastian
- MatlabOutline.pdfÎncărcat detkortiz24
- FreeForm 3Axis 5Axis Essentials.pptxÎncărcat decamb2270
- Quick Refmaerence Guide MatlabÎncărcat deTerry Rabinowitz
- Quick IntroductionÎncărcat deAbhishek Arora
- lec13Încărcat demousa bagherpourjahromi
- EcoSim 5.0 Help SystemÎncărcat dejulia0h
- ExerciseÎncărcat deAwetHaile
- C++ projectÎncărcat deSarvesh Badoni
- Add Maths.pdfÎncărcat desoojung
- 52105 MT Digital Control SystemsÎncărcat dehari0118
- SSC-CGL-Pre-Mock-2Încărcat deAnonymous 1b3ih8zg9
- vojtesek.pdfÎncărcat deFathurRahman

- Obstacle Avoidance With Ultrasonic Sensors-NFkÎncărcat dek1gabitzu9789
- Robotics_and_intelligent_machines_in_agriculture-DA6.pdfÎncărcat deArch
- A_unified_approach_for_motion_and_force_control_of_robot_manipulators_The_operational_space_formulat-PaJ.pdfÎncărcat deArch
- A Robust Layered Control System for a Mobile Robot-WtXÎncărcat deArch
- A Modified SEPIC Converter for High power factor Rectifier and Universal Input Voltage ApplicationsÎncărcat deBritto Tiger
- A_complete_generalized_solution_to_the_inverse_kinematics_of_robots-UgA.pdfÎncărcat deArch
- VSC-Based HVDC Power Transmission Systems an Overview-jLJÎncărcat deJayant Paul
- Single-Phase_to_Single-Phase_Full-Bridge_Converter_Operating_With_Reduced_AC_Power_in_the_DC-Link_Ca-9PV.pdfÎncărcat deArch
- Sensorless_Control_of_Surface-Mount_Permanent-Magnet_Synchronous_Motors_Based_on_a_Nonlinear_Observe-sMC.pdfÎncărcat deArch
- Model-Based_Predictive_Direct_Power_Control_of_Doubly_Fed_Induction_Generators-0tJ.pdfÎncărcat deArch
- Direct_Torque_Control_of_Four-Switch_Brushless_DC_Motor_With_Non-Sinusoidal_Back_EMF-A82.pdfÎncărcat deArch
- Direct_Power_Control_of_Doubly-Fed-Induction-Generator-Based_Wind_Turbines_Under_Unbalanced_Grid_Vol-fCD.pdfÎncărcat deArch
- Design of Parallel Inverters for Smooth Mode Transfer Microgrid Applications-MHLÎncărcat deArch
- A Wide-Inputamp; Wide-Output WIWO DCamp; DC Converter-HIaÎncărcat deArch
- A Single-Phase Z-Source Buckamp; Boost Matrix Converter-ip9Încărcat deArch
- Wideband_Bandpass_Filter_With_Reconfigurable_Bandwidth-ZSN.pdfÎncărcat deArch
- Nonuniformly_Folded_Waveguide_Resonators_and_Their_Filter_Applications-2On.pdfÎncărcat deArch

- Analytical Reasoning - Short NotesÎncărcat deBadaruddin Chachar
- Grade 6 Math Word Problems WorksheetsÎncărcat deNick
- A Biologist’s Guide to Bayesian Phylogenetic AnalysisÎncărcat deLuis Caceres
- trducirÎncărcat deDavid Llusco
- FIITJEE 40Încărcat deBHAAJI0001
- Edge DetectionÎncărcat deAlex Chen
- gs-local_volatility_surfaceÎncărcat derakeshsnair
- Slides Day 2Încărcat deWoodland member
- history of a mathematics topicÎncărcat deapi-121560518
- 2013 Paper Ssc CglÎncărcat deRaghu Ram
- text bookÎncărcat deceice2013
- Darko_Bonacic_LeonardoÎncărcat deJoanna Walewska
- Genaro LinsÎncărcat dejtnylson
- Ship hull inspection.pdfÎncărcat deIvan Costa da Silva
- Grabeex openCVÎncărcat dePablo Del Saz-orozco Huang
- Trinomial TreesÎncărcat deAkanksha Maheshwari
- NUST-Engineering-Pastpaper-5(educatedzone.com).pdfÎncărcat deSaqlain Jhatial
- CPP_v1.1Încărcat deHưởng Plc
- Optimization Design of the U-shaped Metal BellowsÎncărcat dedaymon
- Biokimia1 Prot Enzyme Kinetics_Michaelis MentenÎncărcat deMonica Puspita Sari
- DG152 functionsÎncărcat deمحمد احمد جیلانی
- Vine EtaÎncărcat devish_vinny
- Section2Exercise1_WorkingWithMapProjectionsÎncărcat deMarcel Boscanean
- Act MathÎncărcat debaha146
- Centro de Gravedad Del EquinoÎncărcat deYordan Henriquez
- cms98Încărcat deZhang Zhang
- Exam 1 Solutions.docxÎncărcat dePaul Benedict
- Effect of Cavity Wall VentilationÎncărcat dejuli_rad
- Analysis and Improvement of Jacking Systems for Jack-up RigÎncărcat deImran Siddiqui
- AWB120 Dynamics 04 SpectrumÎncărcat deAmine

## Mult mai mult decât documente.

Descoperiți tot ce are Scribd de oferit, inclusiv cărți și cărți audio de la editori majori.

Anulați oricând.