Академический Документы
Профессиональный Документы
Культура Документы
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
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)
. ) 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)
) 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)
) 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)
KB ; HG HB x B ; g BSB
/
(15) (16)
(17)
) l B ; SB / & G HB / ' H
(18)
Figure 1: Arbitrary
Finally, for revolute joint B equation 13 and 18 can be put , into equation 5 to get
) B;
(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)
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)
S2 & 4 H2 ' 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)
(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.
. . / .
. . =/ /
: ; ; <
(28)
(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
(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)
7 L/ 8 </ 8 8 . 8 8 8 . 9 . .
: ; ; ; ; ; ; <
(36)
: 7 L/ & 1 ' : : = ; 8 < 9 </ & 1 ' < ; ; = ; ; ; ; =/ ; 7 L/ : ; < 9 </ < .
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
Site tools
+ Options
Powe re d by W ik idot.com
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
BZHLab
Mak e rs goe s we st!
Porsche Wiki
Brought to You By R e dLine Te chnik | R e dLine Te chnik .com