0 Up votes0 Down votes

31 views79 pagesjacobien calculation

Aug 08, 2016

© © All Rights Reserved

PDF, TXT or read online from Scribd

jacobien calculation

© All Rights Reserved

31 views

jacobien calculation

© All Rights Reserved

- Rigid Joint
- Solutions to Concepts of Physics by HC Verma Chapter 10
- Design of a Fluidized Drum Granulator
- hsc-physics-i-board-paper-2013.pdf
- Autocad Video
- phy07.pdf
- Python Tutorial
- Dynamics Formulae
- 1538107078CLASS 11TH PHYSICS (1)
- Part Test jeeMain
- Systems of Particles and Rotational Motion
- Systems Engineering
- Lan
- Linear Algebra 022315
- ALG 55
- phy-pdf-1
- MIT8_044S14_exam3_04 (1).pdf
- 13.pdf
- Final Exam
- Fundamentos matematicos señales

You are on page 1of 79

io

Inverse Kinematics:

Manipulator Jacobian

Conservatively tuned IK

Aggressively tuned IK

Jacobian Transpose

UM EECS 398/598 - autorob.github.io

Target

endeffector

location

Current

endeffector

location

Endeffector

error

endeffector to

minimize error?

Desired

endeffector

displacement

Can we move the

endeffector to

minimize error?

Joint angle

displacements

Yes.

Convert linear velocity of

endeffector to angular

velocities at joints.

v1

r2

rotation axis

angular rotation in frame

r1

v2

r3

angular velocity

of points in frame

wrt. axis k

v3

k axis out-of-plane

and passes through frame origin

v1

r2

linear velocity

of points in frame

wrt. axis k

vector to point

in frame

rotation axis

r1

v2

r3

angular velocity

of points in frame

wrt. axis k

v3

k axis out-of-plane

and passes through frame origin

angular velocity

of points in frame

wrt. axis k

linear velocity

of points in frame

wrt. axis k

vector to point

in frame

endeffector

linear velocity

rotation axis

vector from

joint origin to

endeffector

joint rotation axis

UM EECS 398/598 - autorob.github.io

vector from

joint origin to

endeffector

endeffector

linear velocity

Why?

Jacobian Transpose

vector from

joint origin to

endeffector

endeffector

linear velocity

How to obtain joint angular

velocity from endeffector

linear velocity?

Jacobian Transpose

vector from

joint origin to

endeffector

endeffector

linear velocity

How to obtain joint angular

velocity from endeffector

linear velocity?

Jacobian Transpose

Angular

velocity

for joint i

endeffector

linear velocity

vector from

joint origin to

endeffector

Jacobian

for joint i

1) Compute Jacobian

2) Update joint angles using Jacobian transpose

3) Repeat forever (or until error minimized)

Define error function e(q) as difference

between current and desired endeffector

poses

e(q)

configuration q

Find global minimum of e(q),

ie. argminq e(q)

Define error function e(q) as difference

between current and desired endeffector

poses

e(q)

configuration q

Find global minimum of e(q),

ie. argminq e(q)

How could we find argminq e(q) if we knew

e(q) in closed form?

UM EECS 398/598 - autorob.github.io

Take derivative

Verify

UM EECS 398/598 - autorob.github.io

Take derivative

Verify

UM EECS 398/598 - autorob.github.io

Define error function e(q) as difference

between current and desired endeffector

poses

e(q)

configuration q

Find global minimum of e(q),

ie. argminq e(q)

But, do we know e(q) in closed form?

UM EECS 398/598 - autorob.github.io

rate of change of f(x) at x0 is J(x0)

x0-x x0 x0+x

as first order expansion, approximate f(x) at

current configuration x0 and tangent plane J(x0)

UM EECS 398/598 - autorob.github.io

minimization function F

of steepest ascent away from goal

f(x)

of steepest ascent away from goal

x

UM EECS 398/598 - autorob.github.io

Minimum (Goal)

of steepest ascent away from goal

Start (Initial)

UM EECS 398/598 - autorob.github.io

Minimum (Goal)

of robot configuration

wrt. endeffector error?

Start (Initial)

UM EECS 398/598 - autorob.github.io

Geometric

3D N-link arm

The Jacobian

A 6xN matrix

Each column transforms

velocity at the endeffector

to velocity at a DOF

UM EECS 398/598 - autorob.github.io

Endeffector

velocity

Configuration

velocity

3D N-link arm

The Jacobian

A 6xN matrix

i=0 is base frame

Note: figure taken from Spong et al. textbook, which

assumes D-H parameters and offset column index

UM EECS 398/598 - autorob.github.io

3D N-link arm

The Jacobian

A 6xN matrix

3D N-link arm

The Jacobian

A 6xN matrix

Change in endeffector

variable with respect to

change in joint variable

UM EECS 398/598 - autorob.github.io

3D N-link arm

The Jacobian

A 6xN matrix

linear

angular

3D N-link arm

The Jacobian

A 6xN matrix

linear

angular

3D N-link arm

The Jacobian

A 6xN matrix

linear

angular

angular velocity of endeffector

vector of

of joint

angle

velocities

UM EECS 398/598 - autorob.github.io

The Jacobian

3D N-link arm

A 6xN matrix

linear

angular

Ji is a single column

of the Jacobian matrix

Z is joint axis in

world coordinates

(overloaded notation)

vectors in

base frame

The Jacobian

A 6xN matrix

oi-1: joint

origin

linear

on: endeffector

angular

Jvi

The Jacobian

A 6xN matrix

linear

angular

The Jacobian

A 6xN matrix

linear

angular

v1

r2

angular velocity

of points in frame

wrt. axis k

r1

v2

linear velocity

of points in frame

wrt. axis k

r3

rotation axis

v3

k axis out-of-plane

and passes through frame origin

vector to point

in frame

skew-symmetric

matrix

Note: velocity dependent on frame, not

necessarily linear velocity at point

v1

r2

angular velocity

of points in frame

wrt. axis k

r1

v2

linear velocity

of points in frame

wrt. axis k

r3

rotation axis

v3

k axis out-of-plane

and passes through frame origin

vector to point

in frame

skew-symmetric

matrix

UM EECS 398/598 - autorob.github.io

transform to

base to frame 1

Angular Velocity

Linear Velocity

p1 is point in

frame 1

plus linear rotation of point

UM EECS 398/598 - autorob.github.io

Angular Velocity

(0..n) on endeffector

UM EECS 398/598 - autorob.github.io

ith joint angle

Geometric

The Jacobian

A 6xN matrix

Procedure restated:

Geometric

The Jacobian

A 6xN matrix

compute

endpoint

error

Procedure restated:

compute step

direction

repeat

perform step

direction

UM EECS 398/598 - autorob.github.io

Geometric

The Jacobian

A 6xN matrix

can we invert J(q)?

The Jacobian

A 6xN matrix

when can we invert J(q)?

Jacobian Transpose

Jacobian Transpose

Jacobian gives mapping from

configuration displacement to

endeffector displacement

Inverse of Jacobian maps

endeffector displacement to

configuration displacement

But, inverse of Jacobian is

rarely an option. Why?

Instead, find configuration

displacement that minimizes

endeffector error squared

UM EECS 398/598 - autorob.github.io

Instead, find configuration

displacement that minimizes

endeffector error squared

expressing squared error

expressing squared error

Matlab example:

Jacobian transpose

Initial configuration

Iterations to goal

Pseudo Inverse

Matlab example:

Pseudo Inverse

Initial configuration

Iterations to goal

Pseudo Inverse,

More Generally

to linear system Ax=b

solution of an overdetermined system Ax=b, where there are

more equations (m) than unknowns (n), or vice versa

http://lion.cs.uiuc.edu/projects/wmn.html

expressing squared error

Normal form

IK Demo

Which Pseudoinverse

Left pseudoinverse, for when N > M, (i.e., less than than 6 DoFs)

s.t.

s.t.

UM EECS 398/598 - autorob.github.io

Which Pseudoinverse

What happens when

J is not full rank?

Left pseudoinverse, for when N > M, (i.e., less than than 6 DoFs)

s.t.

s.t.

UM EECS 398/598 - autorob.github.io

Singularities

UM EECS 398/598 - autorob.github.io

NxM matrix

NxN matrix

Columns are orthonormal

eigenvectors of AAT

MxM matrix

Columns are orthonormal

eigenvectors of ATA

Singular values

Diagonal NxM matrix

eigenvalues of ATA and AAT

reciprocals of diagonal of D

UM EECS 398/598 - autorob.github.io

approach to IK?

http://www.ryanjuckett.com/programming/cyclic-coordinate-descent-in-2d/

Initial

Rotate bone 3

(to place end effector as

close to target as possible)

http://www.ryanjuckett.com/programming/cyclic-coordinate-descent-in-2d/

https://www.youtube.com/watch?v=MvuO9ZHGr6k

Jacobian-based methods

UM EECS 398/598 - autorob.github.io

IK Assignment

EECS 398-002

EECS 598-010

UM EECS 398/598 - autorob.github.io

IK Assignment

Specify target location, endeffector frame, endeffector point in frame

home.html

// if requested, perform inverse kinematics control to reach to point

kineval.robotInverseKinematics(kineval.params.ik_target, robot.endeffector.frame, robot.endeffector.position);

kineval_inverse_kinematics.js

kineval.robotInverseKinematics(endeffector_target_world, endeffector_joint, endeffector_position_local) {

. . .

kineval.iterateIK(endeffector_target_world, endeffector_joint, endeffector_position_local);

if (kineval.params.trial_ik_random.execute)

kineval.randomizeIKtrial();

else

kineval.params.trial_ik_random.start = new Date();

}

}

kineval.iterateIK(endeffector_target_world, endeffector_joint, endeffector_position_local) {

// Your code for a single IK iteration

// output sets updated controls for each joint

}

world

IK Assignment

global

endeffector point in frame

Transform endeffector into world

UM EECS 398/598 - autorob.github.io

IK Assignment

Form kinematic chain

Transform endeffector into world

Iterate over kinematic chain to update robot.controls

Build Jacobian and compute Jacobian Transpose and Psuedoinverse

Apply updated controls to each joint

Matrix inversion provided by numericjs

numeric.inv(J)

IK Assignment

Form kinematic chain

Transform endeffector into world

Iterate over kinematic chain to update robot.controls

Build Jacobian and compute Jacobian Transpose and Psuedoinverse

Apply updated controls to each joint

Ensure your matrix routines work with kineval.js

e.g., generate_translation_matrix takes 3 parameters

UM EECS 398/598 - autorob.github.io

Next class:

Motion Planning

http://people.csail.mit.edu/aperez/www/files/rrt_timelapse.jpg

- Rigid JointUploaded byapriani_april
- Solutions to Concepts of Physics by HC Verma Chapter 10Uploaded byJaspal Singh
- Design of a Fluidized Drum GranulatorUploaded byditchche
- hsc-physics-i-board-paper-2013.pdfUploaded byprthr
- Autocad VideoUploaded byRizkyLukman
- phy07.pdfUploaded byPrasad Yarra
- Python TutorialUploaded byjunyhui
- Dynamics FormulaeUploaded byDiego A. Pulido Ramos
- 1538107078CLASS 11TH PHYSICS (1)Uploaded bySS SSS
- Part Test jeeMainUploaded byVikas Meena
- Systems of Particles and Rotational MotionUploaded byShrija Sheth
- Systems EngineeringUploaded byJayden Closter
- LanUploaded byFarahat Khan
- Linear Algebra 022315Uploaded byAdeniji Adetayo
- ALG 55Uploaded byS.T
- phy-pdf-1Uploaded byab
- MIT8_044S14_exam3_04 (1).pdfUploaded by*83*22*
- 13.pdfUploaded bysemselvan794694
- Final ExamUploaded byPercival Adonis Casino
- Fundamentos matematicos señalesUploaded byAndres Benitez
- RunoutUploaded byreynancs
- ME242 Student Lab Manual MEL II Updated 25 Jan18Uploaded byMalik Salal
- 10-1-physics-2-dynamics-of-rotational-motion.pptxUploaded byShirley Tan
- Lecture 36Uploaded byChernet Tuge
- Raghu PaperUploaded bygrskrishna
- Jee main paperUploaded byMOMI MALA BORA
- 2001_Paper IIIUploaded byhmphry
- Kinematics Mobile RobotsUploaded byTung Duong
- Matlab File CompleteUploaded byRyan Michael
- 1jot_12Uploaded byAlak Majumder

- MA860Hm manual userUploaded byHứa Chí Quân
- Cpp Practice ExamUploaded byVon Dominic
- 600 Confusing English Words ExplainedUploaded byThiep Vu
- CpaUploaded byHứa Chí Quân
- Capstone Report FormatUploaded byArvin F. Villodres
- ENG311Uploaded byHứa Chí Quân
- Multisim Digital PrimerUploaded bysuresh151971
- Constructive AnatomyUploaded bygazorninplotz

- Practical No 1 OUTPUTUploaded byRoshan Dudhalkar
- math.ce1Uploaded byOsama Hassan
- List of matrices_2.pdfUploaded bymars
- hw03 math 484Uploaded byHuizhou Yin
- Operatii operatii pe matrici javaPe Matrici JavaUploaded byBogdan Mates
- Problems_05.pdfUploaded bymitsuosakamoto
- Matrix DecompUploaded byRamesh Kumar
- i n Herstein Topics in Algebra 2nd Edition 1975 Wiley International Editions John Wiley and Sons Wie 1975Uploaded bySachin Rajoria
- g13-resolUploaded byRonny Joel
- Matrix CookbookUploaded byAli Ghelmani
- Lect2-08web.pdfUploaded bySceptic Granny
- 4.1--4.2 math hwUploaded byJets Campbell
- Mathematics for Inverse Kinematics.pdfUploaded bykraskrom
- Rits_MM_QB_For_Mid_IUploaded bygnathw
- notes243MUploaded byRonald
- A Geometric Review of Linear AlgebraUploaded byfengw89
- Solutions of Differential Equations Using Exponential of MatrixUploaded byMeaziye
- Property of DeterminantsUploaded byabd_ren_ren
- Advance MathUploaded byMichael Damian
- Laporan MatrixUploaded byKesi Chandra
- LinAlg OutlineUploaded byRichard Eden
- mat67-Ll-Spectral_Theorem.pdfUploaded byDzenis Pucic
- Matrix Methods - Applied Linear Algebra 3rd Ed - Bronson,Costa.pdfUploaded byaufal Riswan
- Algebra-Through-Practice-Volume-2-Matrices-and-Vector-Spaces-A-Collection-of-Problems-in-Algebra-with-Solutions.pdfUploaded bysohamdey
- Matrices and DeterminantsUploaded byRaja Ram
- Matlab GuideUploaded bythuleoz
- R MatricesUploaded byNawarajPokhrel
- hw1Uploaded byjohanpenuela
- Leas Squares Excel vs by HandUploaded bythe_strongrock
- LSA pptUploaded bySachin

## Much more than documents.

Discover everything Scribd has to offer, including books and audiobooks from major publishers.

Cancel anytime.