Skip to main content Accessibility help
×
Hostname: page-component-84b7d79bbc-lrf7s Total loading time: 0 Render date: 2024-07-30T03:38:16.566Z Has data issue: false hasContentIssue false

4 - Forward Kinematics

Published online by Cambridge University Press:  04 June 2024

Kevin M. Lynch
Affiliation:
Northwestern University, Illinois
Frank C. Park
Affiliation:
Seoul National University
Get access

Summary

The forward kinematics of a robot refers to the calculation of the position and orientation of its end-effector frame from its joint coordinates θ. Figure 4.1 illustrates the forward kinematics problem for a 3R planar open chain. The link lengths are L1, L2, and L3. Choose a fixed frame ﹛0﹜ with origin located at the base joint as shown, and assume an end-effector frame ﹛4﹜ has been attached to the tip of the third link. The Cartesian position (x, y) and orientation ϕ of the end-effector frame as functions of the joint angles (θ1, θ2, θ3) are then given by

If one is only interested in the (x, y) position of the end-effector, the robot's task space is then taken to be the x–y-plane, and the forward kinematics would consist of Equations (4.1) and (4.2) only. If the end-effector's position and orientation both matter, the forward kinematics would consist of the three equations (4.1)– (4.3).

While the above analysis can be done using only basic trigonometry, it is not difficult to imagine that for more general spatial chains the analysis can become considerably more complicated. A more systematic method of deriving the forward kinematics might involve attaching reference frames to each link; in Figure 4.1 the three link reference frames are respectively labeled ﹛1﹜, ﹛2﹜, and ﹛3﹜. The forward kinematics can then be written as a product of four homogeneous transformation matrices:

Observe that T34 is constant and that each remaining Ti−1,i depends only on the joint variable θi.

As an alternative to this approach, let us define M to be the position and orientation of frame ﹛4﹜ when all joint angles are set to zero (the “home” or “zero” position of the robot). Then

Now consider each revolute joint axis to be a zero-pitch screw axis. If θ1 and θ2 are held at their zero position then the screw axis corresponding to rotating about joint 3 can be expressed in the ﹛0﹜ frame as

You should be able to confirm this by simple visual inspection of Figure 4.1. When the arm is stretched out straight to the right at its zero configuration, imagine a turntable rotating with an angular velocity of ω3 = 1 rad/s about the axis of joint 3.

Type
Chapter
Information
Modern Robotics
Mechanics, Planning, and Control
, pp. 116 - 145
Publisher: Cambridge University Press
Print publication year: 2017

Access options

Get access to the full version of this content by using one of the access options below. (Log in options will check for institutional or personal access. Content may require purchase if you do not have access.)

Save book to Kindle

To save this book to your Kindle, first ensure coreplatform@cambridge.org is added to your Approved Personal Document E-mail List under your Personal Document Settings on the Manage Your Content and Devices page of your Amazon account. Then enter the ‘name’ part of your Kindle email address below. Find out more about saving to your Kindle.

Note you can select to save to either the @free.kindle.com or @kindle.com variations. ‘@free.kindle.com’ emails are free but can only be saved to your device when it is connected to wi-fi. ‘@kindle.com’ emails can be delivered even when you are not connected to wi-fi, but note that service fees apply.

Find out more about the Kindle Personal Document Service.

Available formats
×

Save book to Dropbox

To save content items to your account, please confirm that you agree to abide by our usage policies. If this is the first time you use this feature, you will be asked to authorise Cambridge Core to connect with your account. Find out more about saving content to Dropbox.

Available formats
×

Save book to Google Drive

To save content items to your account, please confirm that you agree to abide by our usage policies. If this is the first time you use this feature, you will be asked to authorise Cambridge Core to connect with your account. Find out more about saving content to Google Drive.

Available formats
×