ROBOT DYNAMICS

15
ROBOT DYNAMICS (Differential Motion Of Frame, Jacobian, Static Force Analysis Of Robot) By R.C.Saini www.rcsaini.blogspot.com

description

Differential Motion Of Frame, Jacobian, Static Force Analysis Of Robot

Transcript of ROBOT DYNAMICS

Page 1: ROBOT DYNAMICS

ROBOT DYNAMICS(Differential Motion Of Frame, Jacobian,

Static Force Analysis Of Robot)By

R.C.Sainiwww.rcsaini.blogspot.com

Page 2: ROBOT DYNAMICS

Differential Relationship• Consider simple mechanism with

2-degrees of freedom

• Each link can rotate independently

• Rotation of link 1 (θ1), relative to reference frame

• 2nd link rotation (θ2), relative to link 1

• Velocity of point B :

2www.rcsaini.blogspot.com

Page 3: ROBOT DYNAMICS

• Writing the velocity equation in matrix form :

• Velocity relationship by differentiating the equation that describe the position of point B :

• Differentiating with respect to θ1, θ2

• In matrix form

3www.rcsaini.blogspot.com

Page 4: ROBOT DYNAMICS

JACOBIAN

• Representation of geometry of the element of the mechanism in time

• Its allow conversion of differential motion of individual joints to differential motion of point of interest

• Also relate individual joint motion to overall mechanism

• It is time related• θ1, θ2 vary in time• As per earlier slide – Jacobian was formed by

differentiated position equations with respect to θ1, θ2

4www.rcsaini.blogspot.com

Page 5: ROBOT DYNAMICS

• Suppose that we have a set of equation Yi in terms of a set of variables Xj

• Differentiating

• In matrix

5www.rcsaini.blogspot.com

Page 6: ROBOT DYNAMICS

JACOBIAN Cont.• Or

• dx, dy and dz – differential motion of the hand along x, y and z axis• δx, δy and δz – differential rotation of the hand around x, y and z axis• Dθ – differential motion of the joint

6www.rcsaini.blogspot.com

Page 7: ROBOT DYNAMICS

Differential Motion Of Frame

• Dived into 3 types :-– Differential Translation– Differential Rotation– Differential Transformation (translation + rotation)

• Differential Translation dx, dy and dz with respect to x, y and z axis

www.rcsaini.blogspot.com 7

Page 8: ROBOT DYNAMICS

Differential Motion Of Frame• Differential Rotation– δx , δy and δz are differential rotation about x, y and

z axis respectively– Use following approximation :

– So ,

www.rcsaini.blogspot.com 8

Page 9: ROBOT DYNAMICS

Differential Motion Of Frame• Differential Rotation– Rotation about a general axis “k”Rot(k, dθ)=Rot(x, dθ) X Rot(y, dθ) X Rot(z, dθ)

- Neglecting higher order differential

www.rcsaini.blogspot.com 9

Page 10: ROBOT DYNAMICS

Differential Motion Of Frame• Differential Transformation (translation + rotation)

• Original frame = T• Differential transformation = dT[T+dT] = [Trans(dx,dy,dz) Rot(k, dθ)] [T][dT] = [Trans(dx,dy,dz) Rot(k, dθ) – I][T] , {I = Unit Matrix}Δ = Trans(dx,dy,dz) Rot(k, dθ) – IΔ = Differential Operator

Δ =

www.rcsaini.blogspot.com 10

Page 11: ROBOT DYNAMICS

Differential Changes Between Frames

• Δ represents a differential operator relative to fixed reference frame and it technically u Δ

www.rcsaini.blogspot.com 11

Page 12: ROBOT DYNAMICS

Static Force Analysis Of Robot

• Robot may be under either position control or force control

• E.g. – Robot follow prescribes path to cut groove in flat surface, it is under position control. However, if the surface has a slight unknown curvature in it, but robot following a given path, it will groove more deeper or less deeper on surface. Alternatively, suppose that the robot were to measure the force of exerting on the surface while cutting the groove. Now robot adjust the depth by joint+link movement for uniformly cut, now it is under force control.

www.rcsaini.blogspot.com 12

Page 13: ROBOT DYNAMICS

Static Force Analysis Of Robot• To relate the joint forces and torques to forces and moments generated at

the hand frame of the robot, we define

www.rcsaini.blogspot.com 13

Page 14: ROBOT DYNAMICS

Static Force Analysis Of Robot

www.rcsaini.blogspot.com 14

Page 15: ROBOT DYNAMICS

THANK YOU

www.rcsaini.blogspot.com 15