Attribution Non-Commercial (BY-NC)

12 views

Attribution Non-Commercial (BY-NC)

- 1971-TYC_BLL.pdf
- Stanford_Daily_19780925_0001.pdf
- LandauReading.pdf
- 1964, Carlson, Middleton, NASA TN D-2341.pdf
- Reading List
- 1950, G. Taylor, The formation of a blast wave by a very intense explosion, 1, taylor.blast.wave.II.pdf
- 1983, Holst T. L., Numerical Computation of Transonic Flow Governed by the Full-Potential Equation, NASA TM 84310.pdf
- 1980, Woodward F.A. USSAERO COMPUTER PROGRAM DEVELOPMENT, VERSIONS B AND C - NASA CR, 1980 N 3227.pdf
- 1908, 1950, Blasius H. the Boundary Layers in Fluids With Little Friction-German-Grenzschichten in Fluessigkeiten Mit Kleiner Reibung 1908 NACA-TM-1256 1950
- 1995, Remembering Lipman Bers
- Macintosh 12'' Monochrome Display - 12_monochrome_display[1]
- 2014Z, optical_modulation_methods[1].pdf
- Logitech Deluxe 660 Cordless Desktop
- 1902, The Hound of the Baskervilles by Sir Arthur Conan Doyle
- hpvectra.pdf
- Manual HP Vectra Vl 420
- 1995, HP Company, PC Service Handbook, Volume 2, 286, 386 and 486 Vectra PCs Introduced before August 1995.pdf
- 2009, Multi-core Programming for Medical Imaging.pdf
- 2013Z, Drag on spherical particles and steady settling velocities.pdf
- 1968, Woodward F.A., Computer Program Analyzes and Designs Supersonic Wing - Body Combinations.pdf

You are on page 1of 31

Differential kinematics

Prof. Alessandro De Luca

Robotics 1

Differential kinematics

relationship between motion (velocity) in the joint space and motion (linear and angular velocity) in the task (Cartesian) space instantaneous velocity mappings can be obtained through time derivation of the direct kinematics function or geometrically at the differential level

different treatments arise for rotational quantities establish the link between angular velocity and time derivative of a rotation matrix time derivative of the angles in a minimal representation of orientation

2

Robotics 1

P2 vP2 - vP1 vP2 r23 P3 P1, P2, P3 rigidity constraint on distances among points: r = constant vPi - vPj orthogonal to rij 1 2 3 2-1=3 vP2 - vP1 = 1 r12 vP3 - vP1 = 1 r13 vP3 - vP2 = 2 r23 1 = 2 = . rij = rij

vP1 P1

r12

vP3 - vP1

r13 vP3

angular velocity is associated to the whole body (not to a point) if P1 with vP1 = 0: pure rotation (circular trajectories for all points) = 0: pure translation (all points have the same velocity vP)

Robotics 1 3

. 1 = z01 . 2 = z12 . v3 = z2 d3 . n = zn-1n v

r = (p,)

T= R p 000 1

v and are vectors, namely elements of vector spaces: they can be obtained as the sum of contributions of the joint velocities (in any order) on the other hand, (and d/dt) is not an element of a vector space: a minimal representation of a sequence of rotations is not obtained by summing the corresponding minimal representations (angles ) in general, d/dt

4

Robotics 1

z y z z y

=

x z y same final position

Robotics 1

example z

initial orientation

z X = 90 y x

mathematical fact: is NOT an exact differential form (the integral of over time depends on the integration path!)

x z Z = 90 x

Z = 90

y X = 90 x

Robotics 1

note: finite rotations still commute when made around the same fixed axis

1 0 0 0 0 cos X -sin X sin X cos X RX(dX) = 1 0 0 0 0 1 -dX dX 1 d Y 0 1

RX(X) =

cos Y 0 sin Y RY(Y) = 0 1 0 -sin Y 0 cos Y cos Z -sin Z RZ(Z) = sin Z cos Z 0 0

RY(dY) =

1 0 0 1 -d Y 0

0

0 1

1 -d Z 0 d Z 1 0 0 0 1

neglecting second- and third-order (infinitesimal) terms

7

in any sequence

Robotics 1

= I + S(d)

let R = R(t) be a rotation matrix, given as a function of time since I = R(t)RT(t), taking the time derivative of both sides yields 0 = d[R(t)RT(t)]/dt = dR(t)/dt RT(t) + R(t) dRT(t)/dt = dR(t)/dt RT(t) + [dR(t)/dt RT(t)]T thus dR(t)/dt RT(t) = S(t) is a skew-symmetric matrix let p(t) = R(t)p a vector (with constant norm) rotated over time comparing dp(t)/dt = dR(t)/dt p = S(t)R(t) p = S(t) p(t) dp(t)/dt = (t) p(t) = S((t)) p(t) we get S = S() .

Robotics 1

p . p

R = S() R

S() = R RT

8

RX((t)) = 1 0 0 0 0 cos (t) -sin (t) sin (t) cos (t)

0 0 0 0 - sin - cos 0 cos - sin

0 0 . 0 . - 0 = S() . 0 0

9

Example

. . T RX() R X() =

0 = 0 0

Robotics 1

RRPY (x, y, z) = RZYX (z, y, x)

the three contributions . . . z, y, x to are simply summed as vectors

TRPY (,) c c -s c s c -s 0 x y 0 0

1 z .

.

.

z = .

.

y y

x x .

RZ(z)RY(y) RZ(z)

1st col in

2nd col in

Robotics 1 10

r= p = fr(q) . r= . fr(q) . p q = Jr(q) q . = q

v = . p = JL(q) JA(q) . . q = J(q) q

Robotics 1

11

y py l1 l2 q1 px . . . . px = - l1 s1 q1 - l2 s12 (q1 + q2) . . . . py = l1 c1 q1 + l2 c12 (q1 + q2) . . . = z = q1 + q2 Jr(q) = x q2 r

- l1 s1 - l2 s12 l1 c1 + l2 c12 1

- l2 s12 l2 c12 1

here, all rotations occur around the same fixed axis z (normal to the plane of motion)

12

Robotics 1

pz q3 q2 d1 q1 py direct kinematics (here, r = p) px = q3 c2 c1 py = q3 c2 s1 pz = d1 + q3 s2 fr(q)

px

Robotics 1

13

Geometric Jacobian

always a 6 x n matrix

JL(q) JA(q)

. q=

A1 An

. q1 . qn

Robotics 1 14

Note: joints beyond the i-th one are considered to be frozen, so that the distal part of the robot is a single rigid body

. . JLi(q) qi = zi-1 di

zi-1

qi = di RF0

. JLi(q) qi . JAi(q) qi

zi-1 di 0

Robotics 1

15

. JLi(q) qi zi-1 Oi-1 qi = . . JAi(q) qi = zi-1 i

pi-1,E

revolute i-th joint . JLi(q) qi . JAi(q) qi

RF0

16

Robotics 1

(

. p0,E E =) vE E = JL(q) . q= JA(q) prismatic i-th joint JLi(q) JAi(q) zi-1 = JL1(q) JLn(q) J (q) J (q)

A1 An

. q1 . qn

zi-1 0

0 0 1

p0,E qi

Robotics 1

all vectors should be expressed in the same reference frame (here, the base frame RF0)

17

y2 y1 y0 l1 x0 z0 = z1 = z2 = 0 0 1 l2 x1 E x2

DENAVIT-HARTENBERG table joint

i 0 0

- s1 c1 0 0 - s12 c12 0 0 0 0 1 0 0 0 1 0

di 0 0

l1c1 l1s1 0 1

ai l1 l2 p0,1

i q1 q2

1 2

c1

0A 1

s1 0 0 c12

J=

z0 p0,E z1 p1,E z0 z1

0A 2

s12 0 0

p0,E

Robotics 1

18

y2 y1 y0 l1 x0 note: the Jacobian is here a 62 matrix, thus its maximum rank is 2 = l2 x1

- l1s1- l2s12 l1c1+ l2c12 0 0 0 1 - l2s12 l2c12 0 0 0 1

compare rows 1, 2, and 6 with the analytical Jacobian at slide #12!

x2 J=

z0 p0,E z1 p1,E z0 z1

Robotics 1

19

RFi Oj

0v

On

the one just computed

n

b) it may be E Oj(q)

rnE

RF0

0 Bv E

0J (q) n

. q

vE = vn + rnE = vn + S(rEn) 0

BR 0

RFB

= =

BR 0

I 0

0 I 0

S(0rEn) I

0v

0

BR (q) 0

0 0J (q) n

S(0rEn(q)) I

Robotics 1

BR (q) 0

. B . q = JE(q) q

never singular!

20

lightweight: only 15 kg in motion motors located in second link incremental encoders (homing) kinematic redundancy degree: n-m=2 compliant in the interaction with environment

Robotics 1

21

the geometric Jacobian 0J8(q) is very complex 4 the mid-frame Jacobian J4(q) is relatively simple!

08

y4 z4 6 rows, 8 columns

x4 04

x0

z0 y0

Robotics 1

22

. p v . . p=v =

. + 1 . + 2

.3 =

r=

J(q) =

0 T()

Jr(q)

Jr(q) =

I 0

0 T-1()

J(q)

Robotics 1

for each column ri of R (unit vector of a frame), . we have

. R = S() R

ri = ri

23

Higher-order differential kinematics

differential relationships between motion in the joint space and motion in the task space can be established at the second order, third order, and so on the analytical Jacobian always weights the highest-order derivative velocity . . r = Jr(q) q .

.. . .. . r = Jr(q) q + Jr(q) q

matrix function N3(q,q,q)

. ..

24

Robotics 1

given a matrix J: m n (m rows, n columns)

(J) min(m,n) (if equality holds, J has full rank) if m = n and J has full rank, J is non singular and the inverse J-1 exists (J) = dimension of the largest non singular square submatrix of J

range (J) = vector subspace generated by all possible linear also called image of J combinations of the columns of J (J)={v Rm : Rn, v = J }

also called null space of J

sum of vector subspaces V1 + V2 = vector space where any element v can be written as v = v1 + v2, with v1 V1 , v2 V2

25

Robotics 1

Robot Jacobian

decomposition in linear subspaces and duality

space of joint velocities

J

0 0

dual spaces

(J)

(JT) + (J) = Rn

(J)

(J) + (JT) = Rm

dual spaces

(JT)

0

space of joint torques

(JT)

0

space of task (Cartesian) forces

JT

(in a given configuration q)

Robotics 1

26

Mobility analysis

(J) = (J(q)), (J) = (J(q)), (JT)= (JT(q)) are locally defined, i.e., they depend on the current configuration q (J(q)) = subspace of all generalized velocities (with linear and/or angular components) that can be instantaneously realized by the robot end-effector when varying the joint velocities in the configuration q if J(q) has max rank (typically = m) in the configuration q, the robot end-effector can be moved in any direction of the task space Rm if (J(q)) < m, there exist directions in Rm along which the robot endeffector cannot instantaneously move

these directions lie in (JT(q)), namely the complement of (J(q)) to the task space Rm, which is of dimension m - (J(q))

when (J(q)) {0} (this is always the case if m<n, i.e., in robots that are redundant for the task), there exist non-zero joint velocities that produce zero end-effector velocity (self motions)

27

Robotics 1

Kinematic singularities

configurations where the Jacobian loses rank loss of instantaneous mobility of the robot end-effector for m=n, they correspond in general to Cartesian poses that lead to a number of inverse kinematic solutions that differs from the generic case in a singular configuration, one cannot find a joint velocity that realizes a desired end-effector velocity in an arbitrary direction of the task space close to a singularity, large joint velocities may be needed to realize some (even small) velocity of the end-effector finding and analyzing in advance all singularities of a robot helps in avoiding them during trajectory planning and motion control

when m = n: find the configurations q such that det J(q) = 0 when m < n: find the configurations q such that all mm minors of J are singular (or, equivalently, such that det [J(q) JT(q)] = 0)

finding all singular configurations of a robot with a large number of joints, or the actual distance from a singularity, is a hard computational task

Robotics 1

28

py l1 l2 q1 p q2 direct kinematics px = l1 c1 + l2 c12 py = l1 s1 + l2 s12

singularities: arm is stretched (q2=0) or folded (q2= ) singular configurations correspond here to Cartesian points on the boundaries of the workspace in general, these singularities separate regions in the joint space with distinct inverse kinematic solutions (e.g., elbow up or down)

29

Robotics 1

pz q3 q2 d1 px q1 det J(q) = q32 c2

direct kinematics px = q3 c2 c1 py = q3 c2 s1 py . p= pz = d1 + q3 s2 analytical Jacobian -q3s1c2 -q3c1s2 c1c2 q3c1c2 -q3s1s2 s1c2 0 q3c2 s2

. . q = J(q) q

singularities: third link is fully retracted (q3=0, double singularity rank J drops to 1) or E-E is along the z axis (q2= /2, simple singularity rank J = 2); if both events happen together, rank J =1 all singular configurations correspond here to Cartesian points internal to the workspace (supposing no limits for the prismatic joint)

30

Robotics 1

n = 6, last three joint axes are revolute and intersect at a point without loss of generality, we can set O6 = W = center of spherical wrist (i.e, choose d6 = 0 in the DH table) J(q) = J11 J21 0 J22

inversion of J is simpler (block triangular structure) since det J(q1,,q5) = det J11 det J22 , there is a decoupling property

det J11(q1,,q3) = 0 provides the arm singularities det J22(q4,q5) = 0 provides the wrist singularities

being J22 = [z3 z4 z5] (in the geometric Jacobian), wrist singularities correspond to situations where z3 z4 z5 are linearly dependent vectors q5 = 0 or q5 = /2 the determinant of J will never depend on q1: why?

31

Robotics 1

- 1971-TYC_BLL.pdfUploaded byAnatoli Krasilnikov
- Stanford_Daily_19780925_0001.pdfUploaded byAnatoli Krasilnikov
- LandauReading.pdfUploaded byAnatoli Krasilnikov
- 1964, Carlson, Middleton, NASA TN D-2341.pdfUploaded byAnatoli Krasilnikov
- Reading ListUploaded byrkukg
- 1950, G. Taylor, The formation of a blast wave by a very intense explosion, 1, taylor.blast.wave.II.pdfUploaded byAnatoli Krasilnikov
- 1983, Holst T. L., Numerical Computation of Transonic Flow Governed by the Full-Potential Equation, NASA TM 84310.pdfUploaded byAnatoli Krasilnikov
- 1980, Woodward F.A. USSAERO COMPUTER PROGRAM DEVELOPMENT, VERSIONS B AND C - NASA CR, 1980 N 3227.pdfUploaded byAnatoli Krasilnikov
- 1908, 1950, Blasius H. the Boundary Layers in Fluids With Little Friction-German-Grenzschichten in Fluessigkeiten Mit Kleiner Reibung 1908 NACA-TM-1256 1950Uploaded byAnatoli Krasilnikov
- 1995, Remembering Lipman BersUploaded byAnatoli Krasilnikov
- Macintosh 12'' Monochrome Display - 12_monochrome_display[1]Uploaded byAnatoli Krasilnikov
- 2014Z, optical_modulation_methods[1].pdfUploaded byAnatoli Krasilnikov
- Logitech Deluxe 660 Cordless DesktopUploaded byAnatoli Krasilnikov
- 1902, The Hound of the Baskervilles by Sir Arthur Conan DoyleUploaded byAnatoli Krasilnikov
- hpvectra.pdfUploaded byAnatoli Krasilnikov
- Manual HP Vectra Vl 420Uploaded bychireadrian8044
- 1995, HP Company, PC Service Handbook, Volume 2, 286, 386 and 486 Vectra PCs Introduced before August 1995.pdfUploaded byAnatoli Krasilnikov
- 2009, Multi-core Programming for Medical Imaging.pdfUploaded byAnatoli Krasilnikov
- 2013Z, Drag on spherical particles and steady settling velocities.pdfUploaded byAnatoli Krasilnikov
- 1968, Woodward F.A., Computer Program Analyzes and Designs Supersonic Wing - Body Combinations.pdfUploaded byAnatoli Krasilnikov
- 1990, Computer Simulation of Molecular Dynamics- Methodology, Applications, And Perspectives in Chemistry by Wilfred E Van Gunsteren and Herman J. C. BerendsenUploaded byAnatoli Krasilnikov
- 2006, A Constrained Particle Dynamics for Continuum-particle Hybrid Method in Micro- And Nano-fluidics, 2006Uploaded byAnatoli Krasilnikov
- 1989, Wiener-Hopf Factorisation of Brownian Motion, Paul McGill, 1989Uploaded byAnatoli Krasilnikov
- 1984, A Molecular Dynamics Method for Simulations in the Canonical Ensemblet by SHUICHI NOSEUploaded byAnatoli Krasilnikov
- 2013Z, Kinematics Third Look, Aae203F03suppUploaded byAnatoli Krasilnikov
- 2013, A Rotating Framework, 02-CoriolisUploaded byAnatoli Krasilnikov
- 1998 Msc Thesis Stress Intensity Factor Distributions in Bimaterial Systems - A Three-dimensional Photoelastic Investigation 1998Uploaded byAnatoli Krasilnikov