Ch. 5: Jacobian. 5.1 Introduction

Transcription

1 5.1 Introduction relationship between the end effector velocity and the joint rates differentiate the kinematic relationships to obtain the velocity relationship Jacobian matrix closely related to the static force/torque transformation by duality an indication of singularity configuration the reverse; inverse problem of determining joint rates for specified end effector velocity

2 5.2 Angular Velocity Ch. 5: Jacobian it is a property of the frame or the body in contrast to the linear velocity, which is a property of the individual point for the fixed axis of rotation, the motion is really a planar problem develop the relationship between the derivative of the rotation matrix and the angular velocity use of skew symmetric matrix

3 Skew symmetric matrix Ch. 5: Jacobian S is skew symmetric T S + S =0 0 a3 a2 S( a) = a 0 a a2 a1 0 x T Sx = ( αa+ βb) = α ( a) + β ( b) ( a) p a p S S S S = T RS a R = S Ra ( ) ( )

4 Derivative of Rotation Matrix and the Angular Velocity ( ) ( ) T T with R θ R θ = I and S + S = 0, it can be shown d R = S ( k ) R dθ k, θ k, θ ( ) ( ω ( )) ( ) ( ) in particular, R t = S t R t when ω t is the angular velocity vector of the rotating frame at time t R R= S R R but R = S ω R ( ω ) ( ) 1 2 2/ /0 2

5 Resultant Angular Velocity determine the resultant angular velocity due to relative rotation of several frames angular velocities (but not the rotation) can be added once they are expressed in the same frame 0 ω = 0 ω + 0 ω ω n/0 1/0 2/1 n/ n n 1 = ω1/0 + 1R ω2/1 + + n 1 R ωn/ n 1

6 5.3 Linear Velocity two frames {0} and {1} are related by point P is rigidly attached to {1}, then p= R r p/ o 1 ( ω ) same as the relative velocity formula o R o = T() t p = R r + o = S R r + o p/ o 1 1/0 1 p/ o 1 = ω r /0 p/ o v o

7 5.4 Derivation of Jacobian Ch. 5: Jacobian Jacobian governs the relationship between the linear/angular velocity of the end effector (a point) to the vector of joint velocities ξ J 0 v n v J 0 q J ωn ω = = = q note that the velocity vector is not the derivative of the position and orientation variables since the angular velocity vector is not the derivative of any particular orientation variables, such as Euler or angle/axis representative parameters

8 Angular Velocity angular velocity of the end effector relative to the base is the sum of the angular velocity contributed by each joint relative to the base frame ω = = θ k [ ] / 1 θ T i for revolute joint i i i i i i ω = 0 i i for prismatic joint i / 1 n ω = ρθ R k= ρθ z n/0 i i i i i i i= 1 i= = 1 1 n zn J ω ρ z ρ n

9 Linear Velocity 0 p n 0 p = q Ch. 5: Jacobian, therefore analytically i= 1 i q i J vi 0 p = q i

10 for prismatic joint i, p= d R k = d z i i i i J vi 0 = zi

11 for revolute joint i, ( ) J = z p o vi i i Ch. 5: Jacobian ω = θ R k = θ z, r = p o i i i i i

12 Ex. Ch. 5: Jacobian

13 5.5 Spatial Velocity Transformation ξ T T T = v ω transformation between two rigidly attached moving frame A ξ A ( ) A A A BR S db BR = A 0 B R B ξ B

14 5.6 Analytical Jacobian Ch. 5: Jacobian depend on the minimal representation for the orientation X d I 0 v = = 1 B ( α ) ω α 0 I 0 = J B ( α ) 0 q q= J ( ) ( ) 1 a q q

15 J a ( q) when I 0 = 1 B Ch. 5: Jacobian ( α ) [ ] ( q) be the z-y-z Euler angle representation representational singularity at 0 J I 0 cψ / sθ sψ / sθ 0 = J 0 sψ cψ 0 cψcθ / sθ sψcθ / sθ 1 α = φ θ ψ T ( q) sθ = 0, θ = 0 or π

16 5.7 Singularities Jq Jq Jq ξ = n n spatial velocity is the linear combination of the columns of the Jacobian matrix need at least 6 independent columns to achieve arbitrary velocity rank of the matrix depends on the configuration q rank ( J ) min ( 6, n) if rank is less than the max. value, the robot is at singular configuration for J be nxn matrix, it will be singular when det ( J ) = 0

17 At singularity, certain directions of motion may be unattainable bounded end effector velocity may correspond to unbounded joint rates bounded joint torque may correspond to unbounded spatial force often, they are points on the boundary of the robot workspace

18 Decoupling of Singularities for robots with spherical wrist, decouple the singularity determination into arm and wrist singularities [ ] J 11 = P O = J21 J 22 J J J partition by choosing the reference frame so that n 2 n 1 n, i.e. the origin is located at the wrist center because robot configuration is independent of the frames used to describe, the singularity happens at where det J = det J11 det J22 = 0 set of singular configurations is the union of arm configs. satisfying det J 11 = 0 and wrist configs. satisfying det J = o = o = o =0

19 wrist config singularities at where the last and the second to last joint axes line up

20 arm config singularities for elbow arm, det J 11 = 0

21 for spherical arm, Ch. 5: Jacobian

22 for SCARA arm, Ch. 5: Jacobian

23 5.8 Static Force/Torque Relationship T τ = J F by principle of the virtual work the equation relates the end effector forces to the joint torques required to equilibrate the robot when no gravity force acts upon it