lecture2-kinematics
lecture2-kinematics
Winter 2019
Lecture 2:
Kinematics of medical robotics
Allison Okamura
Stanford University
kinematics
• The study of movement
• The branch of classical mechanics that describes the
motion of objects without consideration of the
forces that cause it
• Why do you need it?
– Determine endpoint position and/or joint positions
– Calculate mechanism velocities, accelerations, etc.
– Calculate force-torque relationships
degrees of freedom
• Number of independent position variables needed
to in order to locate all parts of a mechanism
• DOF of motion
• DOF of sensing
• DOF of actuation
• The DOF of a mechanism does not always
correspond to number of joints
a remote center of motion (RCM) robot
wikipedia.org
Types of four-bar linkages, s = shortest link, l = longest link
it might help to prototype
round head
paper fasteners
officedepot.com
www.rogersconnection.com/triangles
joints
• Think of a
manipulator/
interface as a set of
bodies connected
by a chain of joints
• Revolute is the
most common
joint for robots
From Craig, p. 69
kinematics for robots
• Allows you to move between Joint Space and Cartesian
Space
Absolute Relative
absolute forward kinematics
x = L1cos(θ1) + L2cos(θ2)
y = L1sin(θ1) + L2sin(θ2)
x = L1cos(θ1) + L2cos(θ1+θ2)
y = L1sin(θ1) + L2sin(θ1+ θ2)
˙
x˙ = Jθ
formulating the Jacobian
Use the
chain rule:
Take
partial
derivatives:
assemble in a matrix
˙
x˙ = Jθ
€
Singularities
• Many devices will have configurations at which the
Jacobian is singular
• This means that the device has lost one or more
degrees of freedom in Cartesian Space
• Two kinds:
– Workspace boundary
– Workspace interior
Singularity Math
• If the matrix is invertible, then it is non-singular.
˙ −1
θ = J x˙
• Can check invertibility of J by taking the
determinant of J. If the determinant is equal to 0,
then J is singular.
• Can use this method to check which values of θ
€will cause singularities.
Calculating Singularities
Simplify text: sin(θ1+θ2)=s12
T
τ=J F
Why is this important for robots?
how do you get this
equation?
The Principle of F ⋅ δx = τ ⋅ δθ
virtual work T T
F δx = τ δθ
states that changing the T T
coordinate frame does F Jδθ = τ δθ
not change the total work T T
of a system
F J =τ
T
J F =τ
suggested references
• Introduction to robotics : mechanics and control
John J. Craig
• Robot modeling and control
Mark W. Spong, Seth Hutchinson, M.Vidyasagar
• A mathematical introduction to robotic manipulation
Richard M. Murray, Zexiang Li, S. Shankar Sastry
• Springer handbook of robotics
B. Siciliano, Oussama Khatib (eds.)
http://site.ebrary.com/lib/stanford/docDetail.action?
docID=10284823
Assignment 1
Problem 0: Commentary on seminar
Problem 1: Read/skim papers, answer questions
Problem 2: Kinematics of the Phantom Omni
Problem 3: Kinematics of a remote-center-of-
motion (RCM) robot
in box