forward kinematics
DESCRIPTION
Forward Kinematics. Professor Nicola Ferrier ME Room 2246, 265-8793 [email protected]. Forward Kinematics. Modeling assumptions Review: Spatial Coordinates Pose = Position + Orientation Rotation Matrices Homogeneous Coordinates Frame Assignment Denavit Hartenberg Parameters - PowerPoint PPT PresentationTRANSCRIPT
![Page 1: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/1.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Forward Kinematics
Professor Nicola FerrierME Room 2246, 265-8793
![Page 2: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/2.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Forward Kinematics• Modeling assumptions• Review:
– Spatial Coordinates• Pose = Position + Orientation
– Rotation Matrices
– Homogeneous Coordinates
• Frame Assignment– Denavit Hartenberg Parameters
• Robot Kinematics– End-effector Position,– Velocity, & – Acceleration
Today
Next
Lecture
![Page 3: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/3.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Industrial Robot
sequence of rigid bodies (links) connected by
means of articulations
(joints)
![Page 4: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/4.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Robot Basics: Modeling
• Kinematics:– Relationship between
the joint angles, velocities & accelerations and the end-effector position, velocity, & acceleration
![Page 5: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/5.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Modeling Robot Manipulators• Open kinematic chain (in this course)
• One sequence of links connecting the two ends of the chain (Closed kinematic chains form a loop)
• Prismatic or revolute joints, each with a single degree of mobility
• Prismatic: translational motion between links• Revolute: rotational motion between links
• Degrees of mobility (joints) vs. degrees of freedom (task)
• Positioning and orienting requires 6 DOF• Redundant: degrees of mobility > degrees of freedom
• Workspace • Portion of environment where the end-effector can
access
![Page 6: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/6.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Modeling Robot Manipulators
• Open kinematic chain – sequence of links with one end constrained to
the base, the other to the end-effector
Base
End-effector
![Page 7: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/7.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Modeling Robot Manipulators
• Motion is a composition of elementary motions
Base
End-effector
Joint 1
Joint 2
Joint 3
![Page 8: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/8.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Kinematic Modeling of Manipulators
• Composition of elementary motion of each link
• Use linear algebra + systematic approach
• Obtain an expression for the pose of the end-effector as a function of joint variables qi (angles/displacements) and link geometry (link lengths and relative orientations)
Pe = f(q1,q2,,qn ;l1,ln,1,n)
![Page 9: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/9.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Pose of a Rigid Body
• Pose = Position + Orientation• Physical space, E3, has no natural
coordinates.• In mathematical terms, a coordinate
map is a homeomorphism (1-1, onto differentiable mapping with a differentiable inverse) of a subset of space to an open subset of R3.– A point, P, is assigned a 3-vector:
AP = (x,y,z) where A denotes the frame of reference
![Page 10: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/10.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
A BX
X
Y
Y
Z
Z
AP = (x,y,z)
BP = (x,y,z)
P
![Page 11: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/11.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Pose of a Rigid Body
• Pose = Position + Orientation
How do we do this?
![Page 12: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/12.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Pose of a Rigid Body
• Pose = Position + Orientation• Orientation of the rigid body
– Attach a orthonormal FRAME to the body– Express the unit vectors of this frame with
respect to the reference frame
XA
YA
ZA
![Page 13: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/13.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Pose of a Rigid Body
• Pose = Position + Orientation• Orientation of the rigid body
– Attach a orthonormal FRAME to the body– Express the unit vectors of this frame with
respect to the reference frame
XA
YA
ZA
![Page 14: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/14.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Rotation Matrices
• OXYZ & OUVW have coincident origins at O– OUVW is fixed to the object
– OXYZ has unit vectors in the directions of the three axes ix, jy,and kz
– OUVW has unit vectors in the directions of the three axes iu, jv,and kw
• Point P can be expressed in either frame:
![Page 15: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/15.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
OXU
V
Y
W
ZAP = (x,y,z)
BP = (u,v,w)
P
![Page 16: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/16.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
OXU
V
Y
W
ZAP = (x,y,z)
P
BP = (u,v,w)
![Page 17: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/17.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
OXU
V
Y
W
ZAP = (x,y,z)
P
BP = (u,v,w)
![Page 18: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/18.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
OXU
V
Y
W
ZAP = (x,y,z)BP = (u,v,w)
P
![Page 19: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/19.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Rotation Matrices
![Page 20: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/20.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Rotation Matrices
1
X axis expressed wrt Ouvw
![Page 21: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/21.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Rotation Matrices
1
Y axis expressed wrt Ouvw
![Page 22: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/22.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Rotation Matrices
1
Z axis expressed wrt Ouvw
![Page 23: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/23.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Rotation Matrices
![Page 24: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/24.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Rotation Matrices
Z axis expressed wrt Ouvw
X axis expressed wrt Ouvw
Y axis expressed wrt Ouvw
![Page 25: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/25.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Rotation Matrices
1
U axis expressed wrt Oxyz
![Page 26: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/26.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Rotation Matrices
U axis expressed wrt Oxyz
V axis expressed wrt Oxyz
W axis expressed wrt Oxyz
![Page 27: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/27.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Properties of Rotation Matrices• Column vectors are the unit vectors of the
orthonormal frame– They are mutually orthogonal– They have unit length
• The inverse relationship is:
– Row vectors are also orthogonal unit vectors
![Page 28: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/28.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Properties of Rotation Matrices
• Rotation matrices are orthogonal
• The transpose is the inverse:
• For right-handed systems
– Determinant = -1(Left handed)
• Eigenvectors of the matrix form the axis of rotation
![Page 29: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/29.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Elementary Rotations: X axis
X Y
Z
![Page 30: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/30.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Elementary Rotations: X axis
X Y
Z
![Page 31: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/31.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Elementary Rotations: Y axis
X Y
Z
![Page 32: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/32.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Elementary Rotations: Z-axis
X Y
Z
![Page 33: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/33.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Composition of Rotation Matrices
• Express P in 3 coincident rotated frames
![Page 34: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/34.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Composition of Rotation Matrices
• Recall for matrices AB BA
(matrix multiplication is not commutative)
Rot[Z,90] Rot[Y,-90]
![Page 35: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/35.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Composition of Rotation Matrices
• Recall for matrices AB BA
(matrix multiplication is not commutative)
Rot[Z,90]
Rot[Y,-90]
![Page 36: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/36.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Rot[Z,90]Rot[Y,-90]
Rot[Z,90] Rot[Y,-90]
![Page 37: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/37.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Rot[z,90]Rot[y,-90] Rot[y,-90] Rot[z,90]
![Page 38: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/38.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Decomposition of Rotation Matrices
• Rotation Matrices contain 9 elements• Rotation matrices are orthogonal
– (6 non-linear constraints)
3 parameters describe rotation
• Decomposition is not unique
![Page 39: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/39.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Decomposition of Rotation Matrices
• Euler Angles
• Roll, Pitch, and Yaw
![Page 40: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/40.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Decomposition of Rotation Matrices
• Angle Axis
![Page 41: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/41.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Decomposition of Rotation Matrices
• Angle Axis
• Elementary Rotations
![Page 42: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/42.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Pose of a Rigid Body
• Pose = Position + Orientation
Ok. Now we know what to do about
orientation…let’s get back to pose
![Page 43: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/43.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Spatial Description of Body
• position of the origin with an orientation
AX Y
Z
B
![Page 44: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/44.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Homogeneous Coordinates
• Notational convenience
![Page 45: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/45.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Composition of Homogeneous Transformations
• Before:
• After
![Page 46: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/46.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Homogeneous Coordinates
• Inverse Transformation
![Page 47: Forward Kinematics](https://reader035.vdocuments.net/reader035/viewer/2022082211/56812a99550346895d8e4f4a/html5/thumbnails/47.jpg)
ME/ECE 439 2007 Professor N. J. Ferrier
Homogeneous Coordinates
• Inverse Transformation
Orthogonal: no matrix inversion!