Вы находитесь на странице: 1из 6

TTU Advanced Robotics

Create account or Sign in Search this site Search

Forum contact

Navigation
Home Forum Recent posts Class Wikis Site members Class Syllabus Latex Help Uploading Photos How to Join This Site?

The Jacobian
Class Wikis The Jacobian Fold Table of Contents Introduction Jacobian Derivation Prismatic Joint Revolute Joint Total Jacobian Singularities Decoupling of Singularities Inverse Velocity Example

Add a new page


new page
e dit this pane l

Introduction
Forward kinematic equations are functions used to relate joint variables to end-effector positions and orientations with respect to a fixed coordinate system. The Jacobian matrix linearly relates joint velocities to end-effector velocities and can be useful in several aspects of robotics: planning and execution of smooth paths, determination of singular configurations, derivation of dynamic equations of motion, and transformation of forces and torques from the end effector to the manipulator joints.

Jacobian Derivation
The relationship between the end-effector velocities and joint velocities can be described with a linear equation:

" m; ) J "

(1)

Where, mis the body velocity vector; J is the joint velocity vector; and ) is the Jacobian matrix. For an n-link serial manipulator, the following expressions apply: "l
. G

; ) l J"

(2) (3)

" x .G ; ) x J "

Where, l . is the linear velocity of the end effector, and x . is G G the angular velocity of the end effector. By separating the Jacobian matrix, and body velocity vector, mand ) are now defined as:

m;

" l .G $ x .G

(4)

and

")l $ ) ; )x

(5)

M Now the BA column of the Jacobian will be derived for a prismatic and revolute joint. Note that the derivation is not detailed, but the end result will be very useful.

Prismatic Joint
M If the BA joint is a prismatic joint, the motion of frame B relative to frame B / is in pure translation, therefore, xB B /

; . ) x equal to zero. . . [3

(6)

M This makes the BA column of

. ) xB ; Y

(7)

The linear velocity of the end effector (l . ) is defined as the G . time derivative of position with respect to a base frame (HG). Using the chain rule, it can be shown that:

. . HG ;

; B .

H.G J JB B

(8)

From the previous equation, it can be concluded that:

) xB ;

H.G JB

(9)

M If the DH convention is followed, and the BA joint is prismatic, pure translation parallel to the S / axis with B magnitude =B can occur. Thus, for a prismatic joint, the following holds true.

. HG ; = BS.B

; J BS.B

(10)

M Finally, if the BA joint is a prismatic, the following can be concluded:

) B;

" SB / $ .

(11)

Revolute Joint
M If the BA joint is a revolute, the angular velocity of frame relative to frame B / can be defined as xB B /

; J BSB

(12)

Therefore,

) x B ; SB

(13)

The linear velocity of the end effector caused by angular rotation at joint Bcan be described by

l B ; x B KB
in which

(14)

K is the vector from the point of rotation to the end

effector. Reffering to Figure 1,

KB ; HG HB x B ; g BSB
/

(15) (16)

For joint B it can now be concluded that ,

S H l B ; g B& B / & G HB / ' '


and

(17)

) l B ; SB / & G HB / ' H

(18)

Figure 1: Arbitrary

G-link serial robot

Finally, for revolute joint B equation 13 and 18 can be put , into equation 5 to get

) B;

" SB / & G HB / ' $ H SB /

(19)

Total Jacobian
For a G-link serial manipulator, the Jacobian is the combination of ) / to ) G vectors as shown

) ; Y / ,, , ) G[ )
Where type.

(20)

) B is defined in equations 11 and 19 according to joint

Singularities
The Jacobian can be used to find singular configurations of a manipulator. When a manipulator is in singular configuration, certain directions of motion are unattainable, or a degree or degrees of freedom are lost. Knowing that the 4 G Jacobian defines a mapping between the joint velocity vector and the end-effector velocity vector (Equation 1), all possible end effector velocities are linear combinations of the columns of the Jacobian matrix.

m; ) / J / ) ) 0 J 0 , ,, ) GJ G

(21)

In order for the end effector to achieve arbitrary velocity ( m 0 4 ), the Jacobian must have 6 linearly independent columns (or rows); meaning, the rank of the Jacobian must equal 6. Note that rank ) F B & G' , and for a 6 DOF serial G 4* robot, rank ) 4. Therefore, if the Jacobian of a 6 degree of freedom robot has a rank of less than 6, a degree or degrees of freedom are lost; this is a singular configuration.

Decoupling of Singularities
The Jacobian matrix for a 6 DOF is square; therefore, if the determinant of the Jacobian is zero, the manipulator is in a singular configuration. Now, consider the case with 3-DOF arm and a 3-DOF spherical wrist. The Jacobian matrix of such a robot can be decoupled to find arm singularities and wrist singularities. The proof begins by partitioning the Jacobian into 1 1 blocks.

) ; Y/ )

" ) // ) . [; ) 0/

) /0$ ) 00

(22)

Since the final three joints are always revolute

) / 0 ; " S1 & 4 H1 ' H

S2 & 4 H2 ' H

S3 & 4 H3 ' $(23) H

Because the three wrist axes intersect at a common point, a common coordinate frame (H can be chosen such that ) . H1 ; H2 ; H3 ; H4 ; H This means

) / 0 ; . 11
In this special case, the Jacobian matrix becomes:

(24)

) ; Y/ )
With determinate

" ) // ) . [; ) 0/

. $ ) 00

(25)

=>M ; =>M / / =>M 00 ) ) )


Now, it can be concluded that robot is in a singular configuration if =>M / / ; . or =>M 00 ; . . Through this ) ) decoupling process, arm singularities are found if =>M / / ) and wrist singularities are found if =>M 00 ; . . )

(26)

; .

Inverse Velocity
Referring to Equation 1, the inverse velocity problem involves finding the joint velocities (J ) that produce a desired endeffector velocity (m When the Jacobian is square and ). nonsingular, the inverse problem can be solved as follows:

J; ) /m

(27)

The inverse velocity solution for a robot not having exactly 6 DOF involves a more complicated approach and will not be shown on this page.

Example
In this example, it is assumed that the forward kinematic equations have been found. Refer to "Forward Kinematic Problem" for the derivation of the following equations.

7 </ 8 8L 3 ./ ; 9 / . . 7< / 8 8 L/ . 30 ; 9 . . 7< < / 1 8 8 L/ <1 . 8 31 ; 9 L1 . . . / .

. . / .

L/ </ . . L/ </ . . L/ </ . .

. . =/ /

: ; ; <

(28)

L/ =0 : </ =0 ; ; =/ < / L/ & 0 ) =1 ' = </ & 0 ) =1 ' = =/ / : ; ; ; <

(29)

</ L1 L / L1 <1 .

(30)

Joint 1 is a revolute. Therefore, ) / is defined by Equation 19. With B; / , S is defined as the projection of the S axis of . frame 0 onto itself, and H. is the distance from the origin of frame 0 to origin of the base frame.

7. : S. ; 9 . < / 7. : H. ; 9 . < .

(31)

(32)

site-name

.wikidot.com

The distance from the base frame to the end effector (HG) can be found in the last column of the transformation matrix 3 .G. In this example, G ; 1, and HG can be directly taken from Edit Join this site Source Explore History Tags Share on the last column of 3 . . 1

7 : L & ) =1 ' = 8 / 0 ; H1 ; 9 </ & 0 ) =1 ' < = =/


Now, directly plug Equations 31-33 into Equation 19.

(33)

7 & ) : 77 : 7 : : </ L/ & 0 ) =1 ' = . (34) =0 =1 ' ; ; 8 ; 89 < 8 8 L/ & 0 ) =1 ' ; 8 . 9 </ & 0 ) =1 ' < ; = = 8 ; 8 ; 8 ; ; " S. & 1 H. ' $ 8 / H . ; =/ ; ; 8 ; 8 )/ ; 8 ; 8 ; 7. : 8 ; 8 ; S. . 9 9. < < 9 < . / /
Joint 2 is prismatic, and ) 0 is determined by Equation 11. Now B; 0, and S represents the projection of S onto S / / . which can be found in the third column of 3 . . /

7 L/ : ; 9 </ < S/ .
Thus,

(35)

77 L : : / 89 < <; ; 8 / ; " $ 8 ; ; S. ; 8 7 . : ; ; 8 )0 ; 8 . . 9 9. < < .

7 L/ 8 </ 8 8 . 8 8 8 . 9 . .

: ; ; ; ; ; ; <

(36)

Joint 3 is a prismatic. In a similar manner as calculated.

) / , ) 1 can be 7 (37) . 8 . 8 80 8 </ L/ & 1 ' = 8 8 L/ 9 </ . : ; ; ; ; ; ; <

77 8 9 L/ 8 </ 8 " S0 & 1 H0 ' $ 8 H . ; 8 )1; 8 8 S0 9

: 7 L/ & 1 ' : : = ; 8 < 9 </ & 1 ' < ; ; = ; ; ; ; =/ ; 7 L/ : ; < 9 </ < .

Using the Equation 20, the total Jacobian can be determined.

7 & ) </ =0 =1 ' 8 8 L/ & 0 ) =1 ' = 8 8 . 8 ) ; Y / ,,, ) G[ ; 8 ) 8 . 9 . /

L/ </ . . . .

: ; ; ; 0</ L/ & 1 ' ; = ; ; ; L/ < </ . . .

(38)

Bibliography
1. Spong, Hutchinson, and Vidyasagar, Robot Modeling and Control Add a New Comment
page revision: 10, last edited: 13 Apr 2010, 07:52 GMT+0530 (743 days ago)

Edit

Tags

History

Files

Print

Site tools

+ Options

Powe re d by W ik idot.com

H elp | T erms of Servic e | P rivac y | Report a bug | Flag as objec tionable

Unle ss othe rwise sta te d, the conte nt of this page is lice nse d unde r C re a tive C om m ons Attribution-Share Alik e 3.0 Lice nse

Other interesting sites

BZHLab
Mak e rs goe s we st!

Dark Souls Wikidot Wiki


Your #1 source of fan provide d tips, strate gie s, FAQ s, and inform aton about Dark Souls

Porsche Wiki
Brought to You By R e dLine Te chnik | R e dLine Te chnik .com

Вам также может понравиться