Download - Forward Kinematics - TU Chemnitz
![Page 1: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/1.jpg)
Forward Kinematics
Dr.-Ing. John Nassour
Artificial Intelligence & Neuro Cognitive Systems FakultΓ€t fΓΌr Informatik
Serial link manipulators
14.11.2017 J.Nassour 1
![Page 2: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/2.jpg)
Suggested literature
β’ Robot Modeling and Controlβ’ Robotics: Modelling, Planning and Control
14.11.2017 J.Nassour 2
![Page 3: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/3.jpg)
Reminder: Right Hand Rules
14.11.2017
Cross product
J.Nassour 3
![Page 4: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/4.jpg)
Reminder: Right Hand Rules
14.11.2017
A right-handed coordinate frame
π
π
π Γ π
π
π
π
π
The first three fingers of your right hand which indicate the relative directions of the x-, y- and z-axes respectively.
J.Nassour 4
![Page 5: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/5.jpg)
Reminder: Right Hand Rules
14.11.2017
Rotation about a vector
πWrap your right hand around the vector withyour thumb (your x-finger) in the direction ofthe arrow. The curl of your fingers indicatesthe direction of increasing angle.
+
J.Nassour 5
![Page 6: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/6.jpg)
Kinematics
The problem of kinematics is to describe the motion ofthe manipulator without consideration of the forces andtorques causing that motion.
The kinematic description is therefore a geometric one.
14.11.2017 J.Nassour 6
![Page 7: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/7.jpg)
Forward Kinematics
Determine the position and orientation of theend-effector given the values for the jointvariables of the robot.
14.11.2017
End-EffectorLink 1
Base
Link 2
Link n-1
Joint 1
Joint 2
Joint 3
Joint n
Joint n-1
Robot Manipulators are composed oflinks connected by joints to form akinematic chain.
J.Nassour 7
![Page 8: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/8.jpg)
Robot Manipulators
14.11.2017
Base
Link i
Prismatic joint
Revolute joint
Revolute joint (R): allows a relative rotation about a single axis. Prismatic joint (P): allows a linear motion along a single axis (extension or retraction).
Spherical wrist: A three degree of freedom rotational joint with all three axes of rotation crossing at a point is typically called a spherical wrist.
J.Nassour 8
![Page 9: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/9.jpg)
The Workspace Of A Robot
14.11.2017
Base
Link i
Prismatic joint
Revolute joint
The total volume its end - effector could sweep as the robotexecutes all possible motions. It is constrained by the geometry ofthe manipulator as well as mechanical limits imposed on thejoints.
J.Nassour 9
![Page 10: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/10.jpg)
Robot Manipulators
14.11.2017
Symbolic representation of robot joints
e.g. A three-link arm with three revolute joints was denoted by RRR.
Joint variables, denoted by π½ for a revolute joint and π for the prismatic joint,represent the relative displacement between adjacent links.
J.Nassour 10
![Page 11: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/11.jpg)
Articulated Manipulators (RRR)
14.11.2017 J.Nassour 11
![Page 12: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/12.jpg)
14.11.2017
Three joints of the rotational type (RRR). It resembles the human arm. The second joint axis is perpendicular to the first one. The third joint axis is parallel to the second one.The workspace of the anthropomorphic robot arm, encompassing all the points that can be reached by the robot end point.
Also called: Anthropomorphic Manipulators
Articulated Manipulators (RRR)
J.Nassour 12
![Page 13: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/13.jpg)
14.11.2017
Elbow Manipulator (RRR)
Workspace
Structure
J.Nassour 13
![Page 14: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/14.jpg)
Spherical Manipulator
14.11.2017
The Stanford Arm
J.Nassour 14
![Page 15: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/15.jpg)
Spherical Manipulator RRP
14.11.2017
Two rotation and one translation (RRP). The second joint axis is perpendicular to the first one and the third axis is perpendicular to the second one.
Workspace
Structure
J.Nassour 15
![Page 16: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/16.jpg)
Spherical Manipulator RRP
14.11.2017
Two rotation and one translation (RRP). The second joint axis is perpendicular to the first one and the third axis is perpendicular to the second one. The workspace of the robot arm has a spherical shape as in the case of the anthropomorphic robot arm.
Workspace
Structure
J.Nassour 16
![Page 17: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/17.jpg)
Spherical Manipulator RRR
14.11.2017
Workspace?
Structure
J.Nassour 17
![Page 18: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/18.jpg)
SCARA Manipulator
14.11.2017
Two joints are rotational and one is translational (RRP).The axes of all three joints are parallel.
Workspace
J.Nassour 18
![Page 19: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/19.jpg)
SCARA Manipulator
14.11.2017
Two joints are rotational and one is translational (RRP).The axes of all three joints are parallel.The workspace of SCARA robot arm is of cylindrical shape.
Workspace
J.Nassour 19
![Page 20: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/20.jpg)
Cylindrical Manipulator
14.11.2017
One rotational and two translational (RPP).The axis of the second joint is parallel to the first axis. The third joint axis is perpendicular to the second one.
Workspace
J.Nassour 20
![Page 21: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/21.jpg)
Cylindrical Manipulator
14.11.2017
One rotational and two translational (RPP).The axis of the second joint is parallel to the first axis. The third joint axis is perpendicular to the second one.
Workspace
J.Nassour 21
![Page 22: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/22.jpg)
The Cartesian Manipulators
14.11.2017
Three joints of the translational type (PPP).The joint axes are perpendicular one to another.
Workspace
J.Nassour 22
![Page 23: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/23.jpg)
The Cartesian Manipulators
14.11.2017
Three joints of the translational type (PPP).The joint axes are perpendicular one to another.
Workspace
J.Nassour 23
![Page 24: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/24.jpg)
14.11.2017
A set of position parameters that describes the full configuration of the system.
Base
Configuration Parameters
J.Nassour 24
![Page 25: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/25.jpg)
14.11.2017
A set of position parameters that describes the full configuration of the system.
Base
9 parameters/link
Configuration Parameters
J.Nassour 25
![Page 26: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/26.jpg)
Generalized Coordinates
A set of independent configuration parameters
π ππππππππππ/ππππ π ππππππππππ ππππππππππππ
14.11.2017 J.Nassour 26
![Page 27: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/27.jpg)
Generalized Coordinates
A set of independent configuration parameters
π ππππππππππ/ππππ π ππππππππππ ππππππππππππ
14.11.2017
πΏπππ 1
Base
πΏπππ 2
πΏπππ π
6n parameters for n moving links
J.Nassour 27
![Page 28: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/28.jpg)
Generalized Coordinates
A set of independent configuration parameters
π ππππππππππ/ππππ π ππππππππππ ππππππππππππ
14.11.2017
πΏπππ 1
Base
πΏπππ 2
πΏπππ ππ πͺπππππππππ
6n parameters for n moving links
J.Nassour 28
![Page 29: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/29.jpg)
Generalized Coordinates
A set of independent configuration parameters
π ππππππππππ/ππππ π ππππππππππ ππππππππππππ
14.11.2017
πΏπππ 1
Base
πΏπππ 2
πΏπππ ππ πͺπππππππππ
6n parameters for n moving links5n constraints for n joints
J.Nassour 29
![Page 30: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/30.jpg)
Generalized Coordinates
A set of independent configuration parameters
π ππππππππππ/ππππ π ππππππππππ ππππππππππππ
14.11.2017
πΏπππ 1
Base
πΏπππ 2
πΏπππ ππ πͺπππππππππ
6n parameters for n moving links5n constraints for n jointsD.O.F: 6n - 5n = n
J.Nassour 30
![Page 31: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/31.jpg)
Generalized Coordinates
14.11.2017
D.O.F: n joints + ?
J.Nassour 31
![Page 32: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/32.jpg)
Generalized Coordinates
14.11.2017
The robot is free to move forward/backward, up/down, left/right (translation in three perpendicular axes) combined with rotation about three perpendicular axes, often termed pitch, yaw, and roll.
J.Nassour 32
![Page 33: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/33.jpg)
Generalized Coordinates
14.11.2017
The robot is free to move forward/backward, up/down, left/right (translation in three perpendicular axes) combined with rotation about three perpendicular axes, often termed pitch, yaw, and roll.
D.O.F: n joints + 6
J.Nassour 33
![Page 34: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/34.jpg)
Operational Coordinates
14.11.2017
ππ ππ ππ ππ
ππ+π ππ+π ππ+π ππ+π
End-effector configuration parameters are a set of π parameters (ππ, ππ, ππ, . . , ππ) that completely specify the end-effector position and orientation with respect to the frame ππ ππ ππ ππ.
ππ+π is the operational point.
A set (ππ, ππ, ππ, . . , πππ) of
independent configuration Parameters ππ: number of degree of freedom of the end-effector.
J.Nassour 34
![Page 35: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/35.jpg)
14.11.2017
Operational Coordinates
Base
ππ
π
πΆ
π
πΆ
Is also called Operational Space
J.Nassour 35
![Page 36: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/36.jpg)
14.11.2017
Joint Coordinates
Base
π½1
π½2π½3
π½1
π½2
π½3
Is also called Joint Space
J.Nassour 36
![Page 37: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/37.jpg)
14.11.2017
Joint Space -> Operational Space
Determine the position and orientation of the end-effector given the values for the joint variables of the robot.
Base
π½1
π½2
π½3
π
πΆ
π
J.Nassour 37
![Page 38: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/38.jpg)
Redundancy
14.11.2017
A robot is said to be redundant if π > ππ. Degree of redundancy: π βππ
Base
ππ = ππ = π
how many solutions exist?
J.Nassour 38
![Page 39: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/39.jpg)
Redundancy
14.11.2017
A robot is said to be redundant if π > ππ. Degree of redundancy: π βππ
Base
ππ = ππ = π
how many solutions exist?
J.Nassour 39
![Page 40: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/40.jpg)
Redundancy
14.11.2017
A robot is said to be redundant if π > ππ. Degree of redundancy: π βππ
Base
ππ = ππ = π
how many solutions exist?
J.Nassour 40
![Page 41: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/41.jpg)
Redundancy
14.11.2017
A robot is said to be redundant if π > ππ. Degree of redundancy: π βππ
Base
ππ = ππ = π
how many solutions exist?
J.Nassour 41
![Page 42: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/42.jpg)
Redundancy
14.11.2017
A robot is said to be redundant if π > ππ. Degree of redundancy: π βππ
Base
ππ = ππ = π
how many solutions exist?
J.Nassour 42
![Page 43: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/43.jpg)
Kinematic Arrangements
14.11.2017
The objective of forward kinematic analysis is to determine the cumulative effect of the entire set of joint variables, that is, to determine the position and orientation of the end effector given the values of these joint variables.
We assume that each joint has one D.O.F
The action of each joint can be described by one real number: the angle of rotation in the case of a revolute joint or the displacement in the case of a prismatic joint.
When joint π is actuated, link π moves.
ππ is the joint variable
J.Nassour 43
![Page 44: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/44.jpg)
Kinematic Arrangements
14.11.2017
Spherical wrist 3 D.O.F
spherical wrist: RRR Linksβ lengths = 0
The objective of forward kinematic analysis is to determine the cumulative effect of the entire set of joint variables, that is, to determine the position and orientation of the end effector given the values of these joint variables.
We assume that each joint has one D.O.F
The action of each joint can be described by one real number: the angle of rotation in the case of a revolute joint or the displacement in the case of a prismatic joint.
J.Nassour 44
![Page 45: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/45.jpg)
Kinematic Arrangements
14.11.2017
Base
To perform the kinematic analysis, we attach a coordinate frame rigidly to each link. In particular, we attach ππππ ππ ππ to ππππ π. This means that, whatever motion the robot executes, the coordinates of any point π on
link π are constant when expressed in the πππ coordinate frame ππ = ππππππππ.When πππππ π is actuated, ππππ π and its attached frame, ππππ ππ ππ, experience a resulting motion.
The frame ππππ ππ ππ, which is attached to the robot base, is referred to as the reference frame.
ππππ ππ ππ
ππππ ππ ππ
ππππ ππ
J.Nassour 45
![Page 46: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/46.jpg)
Kinematic Arrangements
14.11.2017
Base
ππππ ππ ππ
ππππ ππ ππ
ππππ π
The frame ππππ ππ ππ, which is attached to the robot base, is referred to as the reference frame.
To perform the kinematic analysis, we attach a coordinate frame rigidly to each link. In particular, we attach ππππ ππ ππ to ππππ π. This means that, whatever motion the robot executes, the coordinates of any point π on
link π are constant when expressed in the πππ coordinate frame ππ = ππππππππ.When πππππ π is actuated, ππππ π and its attached frame, ππππ ππ ππ, experience a resulting motion.
π
J.Nassour 46
![Page 47: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/47.jpg)
Kinematic Arrangements
14.11.2017
Base
ππππ ππ ππ
ππππ ππ ππ
ππππ π
The frame ππππ ππ ππ, which is attached to the robot base, is referred to as the reference frame.
To perform the kinematic analysis, we attach a coordinate frame rigidly to each link. In particular, we attach ππππ ππ ππ to ππππ π. This means that, whatever motion the robot executes, the coordinates of any point π on
link π are constant when expressed in the πππ coordinate frame ππ = ππππππππ.When πππππ π is actuated, ππππ π and its attached frame, ππππ ππ ππ, experience a resulting motion.
π
J.Nassour 47
![Page 48: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/48.jpg)
Joint And Link Labelling
14.11.2017 J.Nassour 48
![Page 49: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/49.jpg)
Joint And Link Labelling
14.11.2017
ππππ ππ ππLink 0 (fixed)Base frame
J.Nassour 49
![Page 50: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/50.jpg)
Joint And Link Labelling
14.11.2017
ππππ ππ ππLink 0 (fixed)
Joint 1
Link 1
Joint variable π½1
Base frame
J.Nassour 50
![Page 51: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/51.jpg)
Joint And Link Labelling
14.11.2017
ππππ ππ ππLink 0 (fixed)
Joint 1
Link 1
Joint variable π½1
ππππ ππ ππ
Joint 2 Link 2
Joint variable π½2
Base frame
J.Nassour 51
![Page 52: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/52.jpg)
Joint And Link Labelling
14.11.2017
ππππ ππ ππLink 0 (fixed)
Joint 1
Link 1
Joint variable π½1
ππππ ππ ππ
Joint 2 Link 2
Joint variable π½2
Link 3
ππππ ππ ππ
Joint 3
Joint variable π½3
Base frame
J.Nassour 52
![Page 53: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/53.jpg)
Joint And Link Labelling
14.11.2017
ππππ ππ ππLink 0 (fixed)
Joint 1
Link 1
Joint variable π½1
ππππ ππ ππ
Joint 2 Link 2
Joint variable π½2
Link 3
ππππ ππ ππ
Joint 3
Joint variable π½3
ππππ ππ ππ
Base frame
Do we need a specific way to orientate the axes?
J.Nassour 53
![Page 54: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/54.jpg)
14.11.2017
Transformation Matrix
ππππ ππ ππLink 0 (fixed)
Joint 1
Link 1
Joint variable π½1
ππππ ππ ππ
Joint 2 Link 2
Joint variable π½2
Link 3
ππππ ππ ππ
Joint 3
Joint variable π½3
ππππ ππ ππ
Base frame
Suppose π¨π is the homogeneous transformation matrix that describe the position and the orientation of ππππ ππ ππ with respect to ππβπππβπ ππβπ ππβπ.π¨π is derived from joint and link π. π¨π is a function of only a single joint variable.
π¨π = π¨π(ππ)
π¨π(ππ) =πΉ π
πβπ π ππβπ
π π
J.Nassour 54
![Page 55: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/55.jpg)
14.11.2017
Transformation Matrix
The position and the orientation of the end effector (reference frame ππππ ππ ππ) with respect to the base (reference frame ππππ ππ ππ) can be expressed by the transformation matrix:
π = π»ππ = π¨π ππ β¦π¨π(ππ) =
πΉππ ππ
π
π π
The position and the orientation of a reference frame ππππ ππ ππ) with
respect to a reference frame ππππ ππ ππ can be expressed by the transformation matrix:
π»ππ =
π¨π+ππ¨π+πβ¦π¨πβπ π¨π
π°
(π»ππ)βπ
ππ π < πππ π = πππ π > π
J.Nassour 55
![Page 56: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/56.jpg)
14.11.2017
Transformation Matrix
π»ππ =
π¨π+ππ¨π+πβ¦π¨πβπ π¨π
π°
(π»ππ)βπ
ππ π < πππ π = πππ π > π
if π < π then
π»ππ = π¨π+ππ¨π+πβ¦π¨πβπ π¨π =
πΉππ ππ
π
π π
The orientation part: πΉππ = πΉπ+π
π β¦πΉ ππβπ
The translation part: πππ = ππβπ
π+πΉπβππ π π
πβπ
J.Nassour 56
![Page 57: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/57.jpg)
14.11.2017
Link Description
Axis(i-1) Axis(i)Link(i-1)
A link is considered as a rigid body whichdefines the relationship between twoneighboring joint axes of a manipulator.
J.Nassour 57
![Page 58: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/58.jpg)
14.11.2017
Link Description
Axis(i-1) Axis(i)Link(i-1)
The kinematics function of a link is tomaintain a fixed relationship betweenthe two joint axes it supports.
This relationship can be describedwith two parameters:β’ the link length aβ’ the link twist a
J.Nassour 58
![Page 59: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/59.jpg)
14.11.2017
Link Description
Axis(i-1) Axis(i)Link(i-1)
ππβπ Link Lengthmutual perpendicular
Is measured along a line which ismutually perpendicular to bothaxes.The mutually perpendicular alwaysexists and is unique except whenboth axes are parallel.
ππβπ
J.Nassour 59
![Page 60: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/60.jpg)
14.11.2017
Link Description
Axis(i-1) Axis(i)Link(i-1)
πΆπβπ Link Twist
Project both axes π β 1 and πonto the plane whose normal isthe mutually perpendicular line.
Measured in the right-handsense about ππβπ.
ππβπ
πΆπβπ
J.Nassour 60
![Page 61: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/61.jpg)
14.11.2017
Link Description
Intersecting joint axis !
ππβπ Link length ?
πΆπβπ Link Twist ?The sense of πΌπβ1 is free.
Axis(i-1)Axis(i)
πΆπβπ
J.Nassour 61
![Page 62: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/62.jpg)
14.11.2017
Joint Parameters
Axis(i-1) Axis(i)Link(i-1)
ππβπ
πΆπβπ
A joint axis is established atthe connection of two links.
This joint will have twonormals connected to itone for each of the links.
ππ
J.Nassour 62
![Page 63: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/63.jpg)
14.11.2017
Joint Parameters
Axis(i-1) Axis(i)Link(i-1)
ππβπ
πΆπβπ
ππ
π π Link OffsetVariable if joint is prismatic.
The relative position of two links is called link offset whish is the distance between the links (the displacement, along the joint axes between the links).
π π
J.Nassour 63
![Page 64: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/64.jpg)
14.11.2017
Joint Parameters
Axis(i-1) Axis(i)Link(i-1)
ππβπ
πΆπβπ
ππ
π π Link OffsetVariable if joint is prismatic.
The relative position of two links is called link offset whish is the distance between the links (the displacement, along the joint axes between the links).
π½π Joint AngleVariable if joint is revolute.
The joint angle between the normals is measured in a plane normal to the joint axis.
π π
π½π
J.Nassour 64
![Page 65: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/65.jpg)
14.11.2017
Link Description
Axis(i-1) Axis(i)Link(i-1)
ππβπ Link Length
and
πΆπβπ Link Twist
depend on joint axesπ β 1 and π.
ππβπ
πΆπβπ
J.Nassour 65
![Page 66: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/66.jpg)
14.11.2017
Joint Parameters
Axis(i-1) Axis(i)Link(i-1)
ππβπ
πΆπβπ
ππ
π π Link Offsetand
π½π Joint Angle
depend on links π β 1and π.
π π
π½π
J.Nassour 66
![Page 67: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/67.jpg)
14.11.2017
Denavit-Hartenberg Convention
Each π΄ matrix has 6 variables- 3 in the rotation matrix and 3 in the position vector.
DH parameters collapse 6 variables to 4 link and joint parameters if we follow a certain procedure for setting coordinate frames.
J.Nassour 67
![Page 68: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/68.jpg)
14.11.2017
Denavit-Hartenberg Convention
Each π΄ matrix has 6 variables- 3 in the rotation matrix and 3 in the position vector.
DH parameters collapse 6 variables to 4 link and joint parameters if we follow a certain procedure for setting coordinate frames.
ππ is link length of like i (constant unless you reconfigure the robot)
J.Nassour 68
![Page 69: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/69.jpg)
14.11.2017
Denavit-Hartenberg Convention
Each π΄ matrix has 6 variables- 3 in the rotation matrix and 3 in the position vector.
DH parameters collapse 6 variables to 4 link and joint parameters if we follow a certain procedure for setting coordinate frames.
ππ is link length of like i (constant unless you reconfigure the robot)πΆπ is link twist of link i (constant unless you reconfigure the robot)
J.Nassour 69
![Page 70: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/70.jpg)
14.11.2017
Denavit-Hartenberg Convention
Each π΄ matrix has 6 variables- 3 in the rotation matrix and 3 in the position vector.
DH parameters collapse 6 variables to 4 link and joint parameters if we follow a certain procedure for setting coordinate frames.
ππ is link length of like i (constant unless you reconfigure the robot)πΆπ is link twist of link i (constant unless you reconfigure the robot)π π is link offset of link i (prismatic variable)
J.Nassour 70
![Page 71: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/71.jpg)
14.11.2017
Denavit-Hartenberg Convention
Each π΄ matrix has 6 variables- 3 in the rotation matrix and 3 in the position vector.
DH parameters collapse 6 variables to 4 link and joint parameters if we follow a certain procedure for setting coordinate frames.
ππ is link length of like i (constant unless you reconfigure the robot)πΆπ is link twist of link i (constant unless you reconfigure the robot)π π is link offset of link i (prismatic variable)π½π is joint angle of link i (revolute variable)
J.Nassour 71
![Page 72: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/72.jpg)
14.11.2017
Denavit-Hartenberg Matrix
Each homogeneous transformation π΄π is represented as a product of four basic transformations:
where the four quantities are parameters associated with ππππ π and πππππ‘ π.
ππ is link length πΆπ is link twistπ π is link offsetπ½π is joint angle
Reminder:
J.Nassour 72
![Page 73: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/73.jpg)
14.11.2017
Denavit-Hartenberg Matrix
Axis(i-1) Axis(i)Link(i-1)
ππβπ
πΆπβπ
ππ
ππ is link length πΆπ is link twistπ π is link offsetπ½π is joint angle
π π
π½π
J.Nassour 73
![Page 74: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/74.jpg)
14.11.2017
Denavit-Hartenberg Matrix
J.Nassour 74
![Page 75: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/75.jpg)
14.11.2017
it is not necessary that the origin of πππππ π be placed at the physical end of ππππ π.
it is not necessary that frame π be placed within the physical link; πππππ π could lie in free space β so long as πππππ π is rigidly attached to ππππ π.
By a clever choice of the origin and the coordinate axes, it is possible to cut down the number of parameters needed from six to four (or even fewer in some cases).
Denavit-Hartenberg Convention
J.Nassour 75
![Page 76: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/76.jpg)
14.11.2017
Denavit-Hartenberg Convention
DH Coordinate Frame Assumptions
(DH1) The axis π₯1is perpendicular to the axis π§0. (DH2) The axis π₯1 intersects the axis π§0.
Under these conditions, there existunique numbers a, d, π½, πΆ such that:
J.Nassour 76
![Page 77: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/77.jpg)
14.11.2017
Denavit-Hartenberg Convention
Positive sense for π and πΌ
J.Nassour 77
![Page 78: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/78.jpg)
14.11.2017
Rules For Assigning Frames
Rule 1: π§πβ1 is axis of actuation of joint π.Axis of revolution of revolute jointAxis of translation of prismatic joint
Rule 2: Axis π₯π is set so it is perpendicular to and intersects π§πβ1.
Rule 3: Derive π¦π from π₯π and π§π.
J.Nassour 78
![Page 79: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/79.jpg)
Rules For Assigning Frames
14.11.2017 J.Nassour 79
![Page 80: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/80.jpg)
Rules For Assigning Frames
14.11.2017
ππLink 0 (fixed)Base frame
ππ
ππ
Rule 1: ππβπ is axis of actuation of joint π
Base frame
ππ is axis of actuation of joint π.
ππ and ππ are set according tothe right hand rule.
J.Nassour 80
![Page 81: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/81.jpg)
Rules For Assigning Frames
14.11.2017
Rule 1: ππβπ is axis of actuation of joint π
Tool frame
π§π is the approach direction of the tool.π¦π is the slide direction of the gripper.π₯π is the normal direction to other axes.
ππ
ππ
ππ
J.Nassour 81
![Page 82: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/82.jpg)
Rules For Assigning Frames
14.11.2017
Rule 2: Axis ππ is set so it is perpendicular to and intersects ππβπ
Case 1: ππβπ and ππ are not coplanar.
β’ There is only one line possible for π₯π , which is the shortest line from π§πβ1 to π§π . β’ ππ is at intersection of π₯π and π§π .
ππβπ
ππβπ
ππβπ
ππ
ππ
J.Nassour 82
![Page 83: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/83.jpg)
Rules For Assigning Frames
14.11.2017
Rule 2: Axis ππ is set so it is perpendicular to and intersects ππβπ
Case 2: ππβπ and ππ are parallel.
β’ There are an infinite number of possibilities for π₯π from π§πβ1 to π§π . β’ Usually easiest to choose an π₯π that passes through ππβ1(so that ππ = 0). β’ ππ is at intersection of π₯π and π§π . β’ πΌπ = 0 always for this case.
ππβπ
ππβπ
ππβπ
ππ
ππ
J.Nassour 83
![Page 84: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/84.jpg)
Rules For Assigning Frames
14.11.2017
Rule 2: Axis ππ is set so it is perpendicular to and intersects ππβπ
Case 3: ππβπ intersects ππ.
β’ π₯π is normal to the plane of π§πβ1 and π§π . β’ Positive direction of π₯π is arbitrary. β’ ππ naturally sits at intersection of π§πβ1 and π§π but can be anywhere on π§π . β’ ππ = 0 always for this case.
ππβπ
ππβπ
ππβπ
ππ
ππ
J.Nassour 84
![Page 85: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/85.jpg)
Rules For Assigning Frames
14.11.2017
Rule 2: Axis ππ is set so it is perpendicular to and intersects ππβπ
Case 3: ππβπ intersects ππ.
β’ π₯π is normal to the plane of π§πβ1 and π§π . β’ Positive direction of π₯π is arbitrary. β’ ππ naturally sits at intersection of π§πβ1 and π§π but can be anywhere on π§π . β’ ππ = 0 always for this case.
ππβπ
ππβπ
ππβπ
ππ
ππ
J.Nassour 85
![Page 86: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/86.jpg)
Rules For Assigning Frames
14.11.2017
Rule 2: Axis ππ is set so it is perpendicular to and intersects ππβπ
Case 3: ππβπ intersects ππ.
β’ π₯π is normal to the plane of π§πβ1 and π§π . β’ Positive direction of π₯π is arbitrary. β’ ππ naturally sits at intersection of π§πβ1 and π§π but can be anywhere on π§π . β’ ππ = 0 always for this case.
ππβπ
ππβπ
ππβπ
ππ
ππ
J.Nassour 86
![Page 87: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/87.jpg)
D-H Parameters
14.11.2017
ππ is distance from ππβπ to ππ measured along ππ.πΆπ is angle from ππβπ to ππ measured about ππ. π π is distance from ππβπ to ππ measured along ππβπ.
π½π is angle from ππβπ to ππ measured about ππβπ.
ππβπ
ππβπ
ππ
ππ
ππβπ
ππ
π π
π½π
πΆπ
J.Nassour 87
![Page 88: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/88.jpg)
D-H Parameters
14.11.2017
ππ is distance from ππβπ to ππ measured along ππ.πΆπ is angle from ππβπ to ππ measured about ππ. π π is distance from ππβπ to ππ measured along ππβπ.
π½π is angle from ππβπ to ππ measured about ππβπ.
ππβπ
ππβπ
ππ
ππ
ππβπ
ππ
π π
π½π
πΆπ
J.Nassour 88
![Page 89: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/89.jpg)
D-H Parameters
14.11.2017
ππ is distance from ππβπ to ππ measured along ππ.πΆπ is angle from ππβπ to ππ measured about ππ. π π is distance from ππβπ to ππ measured along ππβπ.
π½π is angle from ππβπ to ππ measured about ππβπ.
ππβπ
ππβπ
ππ
ππ
ππβπ
ππ
π π
π½π
πΆπ
J.Nassour 89
![Page 90: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/90.jpg)
D-H Parameters
14.11.2017
ππ is distance from ππβπ to ππ measured along ππ.πΆπ is angle from ππβπ to ππ measured about ππ. π π is distance from ππβπ to ππ measured along ππβπ.
π½π is angle from ππβπ to ππ measured about ππβπ.
ππβπ
ππβπ
ππ
ππ
ππβπ
ππ
π π
π½π
πΆπ
J.Nassour 90
![Page 91: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/91.jpg)
Example: RRP Robot
14.11.2017
Assign coordinate frames so that wecan find DH parameters for this robot.
Joint 3
Joint 1
Joint 2
Tool
π½1
π½2
π 3
J.Nassour 91
![Page 92: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/92.jpg)
Example: RRP Robot
14.11.2017
Joint 3
Joint 1
Joint 2
Tool ππ
ππ
ππ
3π
Assign coordinate frames so that wecan find DH parameters for this robot.
J.Nassour 92
![Page 93: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/93.jpg)
Example: RRP Robot
14.11.2017
Joint 3
Joint 1
Joint 2
Tool ππ
ππ
ππ
ππππππ
3π
Assign coordinate frames so that wecan find DH parameters for this robot.
J.Nassour 93
![Page 94: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/94.jpg)
Example: RRP Robot
14.11.2017
Joint 3
Joint 1
Joint 2
Tool ππ
ππ
ππ
ππππππ
ππ
ππ
ππ
3π
Assign coordinate frames so that wecan find DH parameters for this robot.
J.Nassour 94
![Page 95: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/95.jpg)
Example: RRP Robot
14.11.2017
Joint 3
Joint 1
Joint 2
Tool ππ
ππ
ππ
ππππππ
ππ
ππ
ππ
ππ
ππ
ππ
π³3
3π
Assign coordinate frames so that wecan find DH parameters for this robot.
J.Nassour 95
![Page 96: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/96.jpg)
Example: RRP Robot
14.11.2017
Find DH parameters for thisrobot. Identify the jointvariables.
Joint 3
Joint 1
Joint 2
Tool ππ
ππ
ππ
ππππππ
ππ
ππ
ππ
ππ
ππ
ππ
π³3
3π
J.Nassour 96
![Page 97: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/97.jpg)
Example: RRP Robot
14.11.2017
Find DH parameters for thisrobot. Identify the jointvariables.
ππ is distance from ππβπ to ππ measured along ππ.πΆπ is angle from ππβπ to ππ measured about ππ. π π is distance from ππβπ to ππ measured along ππβπ.
π½π is angle from ππβπ to ππ measured about ππβπ.
Joint 3
Joint 1
Joint 2
Tool ππ
ππ
ππ
ππππππ
ππ
ππ
ππ
ππ
ππ
ππ
π³3
3π
π ππ πΆπ π π π½π
1
2
3
J.Nassour 97
![Page 98: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/98.jpg)
Example: RRP Robot
14.11.2017
Find DH parameters for thisrobot. Identify the jointvariables.
ππ is distance from ππβπ to ππ measured along ππ.πΆπ is angle from ππβπ to ππ measured about ππ. π π is distance from ππβπ to ππ measured along ππβπ.
π½π is angle from ππβπ to ππ measured about ππβπ.
Joint 3
Joint 1
Joint 2
Tool ππ
ππ
ππ
ππππππ
ππ
ππ
ππ
ππ
ππ
ππ
π³3
3π
π ππ πΆπ π π π½π
1 0 β90 Β° 3m π½π = 0 Β°
2
3
J.Nassour 98
![Page 99: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/99.jpg)
Example: RRP Robot
14.11.2017
Find DH parameters for thisrobot. Identify the jointvariables.
ππ is distance from ππβπ to ππ measured along ππ.πΆπ is angle from ππβπ to ππ measured about ππ. π π is distance from ππβπ to ππ measured along ππβπ.
π½π is angle from ππβπ to ππ measured about ππβπ.
Joint 3
Joint 1
Joint 2
Tool ππ
ππ
ππ
ππππππ
ππ
ππ
ππ
ππ
ππ
ππ
π³3
3π
π ππ πΆπ π π π½π
1 0 β90 Β° 3m π½π = 0 Β°
2 0 β90 Β° 0 π½π = β90 Β°
3
J.Nassour 99
![Page 100: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/100.jpg)
Example: RRP Robot
14.11.2017
Find DH parameters for thisrobot. Identify the jointvariables.
ππ is distance from ππβπ to ππ measured along ππ.πΆπ is angle from ππβπ to ππ measured about ππ. π π is distance from ππβπ to ππ measured along ππβπ.
π½π is angle from ππβπ to ππ measured about ππβπ.
Joint 3
Joint 1
Joint 2
Tool ππ
ππ
ππ
ππππππ
ππ
ππ
ππ
ππ
ππ
ππ
π³3
3π
π ππ πΆπ π π π½π
1 0 β90 Β° 3m π½π = 0 Β°
2 0 β90 Β° 0 π½π = β90 Β°
3 0 0 Β° π π = π³π 0 Β°
J.Nassour 100
![Page 101: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/101.jpg)
Example: RRP Robot
14.11.2017
Find DH parameters for thisrobot. Identify the jointvariables.
ππ is distance from ππβπ to ππ measured along ππ.πΆπ is angle from ππβπ to ππ measured about ππ. π π is distance from ππβπ to ππ measured along ππβπ.
π½π is angle from ππβπ to ππ measured about ππβπ.
Joint 3
Joint 1
Joint 2
Tool ππ
ππ
ππ
ππππππ
ππ
ππ
ππ
ππ
ππ
ππ
π³3
3π
π ππ πΆπ π π π½π
1 0 β90 Β° 3m π½π = 0 Β°
2 0 β90 Β° 0 π½π = β90 Β°
3 0 0 Β° π π = π³π 0 Β°
Find the A matrices
J.Nassour 101
![Page 102: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/102.jpg)
Example: RRP Robot
14.11.2017
Find the A matrices Reminder: π¨π
π΄ 1 =
π1 0π 1 0
βπ 1 0π1 0
0 β10 0
0 30 1
π΄ 2 =
π2 0π 2 0
βπ 2 0π2 0
0 β10 0
0 00 1
π΄ 3 =
1 00 1
0 00 0
0 00 0
1 π³π0 1
π ππ πΆπ π π π½π
1 0 β90 Β° 3m π½π = 0 Β°
2 0 β90 Β° 0 π½π = β90 Β°
3 0 0 Β° π π = π³π 0 Β°
J.Nassour 102
![Page 103: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/103.jpg)
Example: RRP Robot
14.11.2017
Find the A matrices Reminder: π¨π
π΄ 1 =
π1 0π 1 0
βπ 1 0π1 0
0 β10 0
0 30 1
π΄ 2 =
π2 0π 2 0
βπ 2 0π2 0
0 β10 0
0 00 1
π΄ 3 =
1 00 1
0 00 0
0 00 0
1 π³π0 1
π ππ πΆπ π π π½π
1 0 β90 Β° 3m π½π = 0 Β°
2 0 β90 Β° 0 π½π = β90 Β°
3 0 0 Β° π π = π³π 0 Β°
J.Nassour 103
![Page 104: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/104.jpg)
Example: RRP Robot
14.11.2017
Find the A matrices Reminder: π¨π
π΄ 1 =
π1 0π 1 0
βπ 1 0π1 0
0 β10 0
0 30 1
π΄ 2 =
π2 0π 2 0
βπ 2 0π2 0
0 β10 0
0 00 1
π΄ 3 =
1 00 1
0 00 0
0 00 0
1 π³π0 1
π 10= π΄ 1 π 2
0= π΄ 1 π΄ 2 =
π1π2 π 1π 1π2 βπ1
βπ1π 2 0βπ 1π 2 0
βπ 2 00 0
βπ2 30 1
π ππ πΆπ π π π½π
1 0 β90 Β° 3m π½π = 0 Β°
2 0 β90 Β° 0 π½π = β90 Β°
3 0 0 Β° π π = π³π 0 Β°
J.Nassour 104
![Page 105: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/105.jpg)
Example: RRP Robot
14.11.2017
Find the A matrices
π 10= π΄ 1 π 2
0= π΄ 1 π΄ 2 =
π1π2 π 1π 1π2 βπ1
βπ1π 2 0βπ 1π 2 0
βπ 2 00 0
βπ2 30 1
=
? ?? ?
? 0? 0
? 00 0
? 30 1
In the current configuration
π ππ πΆπ π π π½π
1 0 β90 Β° 3m π½π = 0 Β°
2 0 β90 Β° 0 π½π = β90 Β°
3 0 0 Β° π π = π³π 0 Β°
J.Nassour 105
Joint 3
Joint 1
Joint 2
Tool ππ
ππ
ππ
ππππππ
ππ
ππ
ππ
ππ
ππ
ππ
π³3
3π
![Page 106: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/106.jpg)
Example: RRP Robot
14.11.2017
Find the A matrices
π 10= π΄ 1
In the current configuration
π ππ πΆπ π π π½π
1 0 β90 Β° 3m π½π = 0 Β°
2 0 β90 Β° 0 π½π = β90 Β°
3 0 0 Β° π π = π³π 0 Β°
J.Nassour 106
Joint 3
Joint 1
Joint 2
Tool ππ
ππ
ππ
ππππππ
ππ
ππ
ππ
ππ
ππ
ππ
π³3
3π
π 20= π΄ 1 π΄ 2 =
π1π2 π 1π 1π2 βπ1
βπ1π 2 0βπ 1π 2 0
βπ 2 00 0
βπ2 30 1
=
0 00 β1
1 00 0
1 00 0
0 30 1
![Page 107: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/107.jpg)
Example: RRP Robot
14.11.2017
Find the A matrices Reminder: π¨π
π΄ 1 =
π1 0π 1 0
βπ 1 0π1 0
0 β10 0
0 30 1
π΄ 2 =
π2 0π 2 0
βπ 2 0π2 0
0 β10 0
0 00 1
π΄ 3 =
1 00 1
0 00 0
0 00 0
1 π³π0 1
π 30= π2
0 π΄ 3 =
π1π2 π 1π 1π2 βπ1
βπ1π 2 0βπ 1π 2 0
βπ 2 00 0
βπ2 30 1
1 00 1
0 00 0
0 00 0
1 πΏ30 1
=
π1π2 π 1π 1π2 βπ1
βπ1π 2 βπΏππ1π 2βπ 1π 2 βπΏππ 1π 2
βπ 2 00 0
βπ2 3 βπΏππ20 1
π ππ πΆπ π π π½π
1 0 β90 Β° 3m π½π = 0 Β°
2 0 β90 Β° 0 π½π = β90 Β°
3 0 0 Β° π π = π³π 0 Β°
J.Nassour 107
![Page 108: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/108.jpg)
Example: RRP Robot
14.11.2017
Find the A matrices
π30 =
π1π2 π 1π 1π2 βπ1
βπ1π 2 βπΏππ1π 2βπ 1π 2 βπΏππ 1π 2
βπ 2 00 0
βπ2 3 βπΏππ20 1
=
? ?? ?
? ?? ?
? 00 0
? ?0 1
In the current configuration
π ππ πΆπ π π π½π
1 0 β90 Β° 3m π½π = 0 Β°
2 0 β90 Β° 0 π½π = β90 Β°
3 0 0 Β° π π = π³π 0 Β°
Joint 3
Joint 1
Joint 2
Tool ππ
ππ
ππ
ππππππ
ππ
ππ
ππ
ππ
ππ
ππ
π³3
3π
J.Nassour 108
![Page 109: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/109.jpg)
Example: RRP Robot
14.11.2017
Find the A matrices
π30 =
π1π2 π 1π 1π2 βπ1
βπ1π 2 βπΏππ1π 2βπ 1π 2 βπΏππ 1π 2
βπ 2 00 0
βπ2 3 βπΏππ20 1
=
0 00 β1
1 πΏ30 0
1 00 0
0 30 1
In the current configuration
π ππ πΆπ π π π½π
1 0 β90 Β° 3m π½π = 0 Β°
2 0 β90 Β° 0 π½π = β90 Β°
3 0 0 Β° π π = π³π 0 Β°
Joint 3
Joint 1
Joint 2
Tool ππ
ππ
ππ
ππππππ
ππ
ππ
ππ
ππ
ππ
ππ
π³3
3π
J.Nassour 109
![Page 110: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/110.jpg)
Example: Two-Link Planar Robot
14.11.2017
Assign coordinate frames so that wecan find DH parameters for this robot.
J.Nassour 110
![Page 111: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/111.jpg)
Example: Two-Link Planar Robot
14.11.2017
Find DH parameters for this robot. Identify the joint variables.
ππ is distance from ππβπ to ππ measured along ππ.πΆπ is angle from ππβπ to ππ measured about ππ. π π is distance from ππβπ to ππ measured along ππβπ.
π½π is angle from ππβπ to ππ measured about ππβπ.
π ππ πΆπ π π π½π
1 π1 0 Β° 0 π½π
2 π2 0 Β° 0 π½π
J.Nassour 111
![Page 112: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/112.jpg)
Example: Two-Link Planar Robot
14.11.2017
Find DH parameters for this robot. Identify the joint variables.
π ππ πΆπ π π π½π
1 π1 0 Β° 0 π½π
2 π2 0 Β° 0 π½π
J.Nassour 112
![Page 113: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/113.jpg)
F.K. For Cylindrical Manipulator
14.11.2017
One rotational and two translational (RPP).The axis of the second joint is parallel to the first axis. The third joint axis is perpendicular to the second one.
β’ Assign coordinate frames so that we can find DH parameters for this robot.β’ Find DH parameters for this robot. Identify the joint variables.
J.Nassour 113
![Page 114: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/114.jpg)
Stanford Arm
14.11.2017 J.Nassour 114
π½π
![Page 115: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/115.jpg)
Stanford Arm
14.11.2017 J.Nassour 115
π½π
π½π
![Page 116: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/116.jpg)
Stanford Arm
14.11.2017 J.Nassour 116
π π
π½π
π½π
![Page 117: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/117.jpg)
Stanford Arm
14.11.2017 J.Nassour 117
π π
π½π
π½π
π½π
![Page 118: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/118.jpg)
Stanford Arm
14.11.2017 J.Nassour 118
π π
π½π
π½π
π½π
π½π
![Page 119: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/119.jpg)
Stanford Arm
14.11.2017 J.Nassour 119
π π
π½π
π½π
π½π
π½π
π½π
![Page 120: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/120.jpg)
Stanford Arm
14.11.2017 J.Nassour 120
π π
π6
π½π
π½π
π½π
π½π
π½π
π2
![Page 121: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/121.jpg)
Stanford Arm
14.11.2017 J.Nassour 121
π π
π6
π½π
π½π
π½π
π½π
π½π
ππ
π2
![Page 122: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/122.jpg)
Stanford Arm
14.11.2017 J.Nassour 122
π π
π6
π½π
π½π
π½π
π½π
π½π
ππ
ππ
π2
![Page 123: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/123.jpg)
Stanford Arm
14.11.2017 J.Nassour 123
π π
π6
π½π
π½π
π½π
π½π
π½π
ππ
ππ
π2
ππ
![Page 124: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/124.jpg)
Stanford Arm
14.11.2017 J.Nassour 124
π π
π6
π½π
π½π
π½π
π½π
π½π
ππ
ππ
π2
ππ
ππ
![Page 125: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/125.jpg)
Stanford Arm
14.11.2017 J.Nassour 125
π π
π6
π½π
π½π
π½π
π½π
π½π
ππ
ππ
π2
ππ
ππ
ππ
![Page 126: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/126.jpg)
Stanford Arm
14.11.2017 J.Nassour 126
π π
π6
π½π
π½π
π½π
π½π
π½π
ππ
ππ
π2
ππ
ππ
ππ
ππ
![Page 127: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/127.jpg)
Stanford Arm
14.11.2017 J.Nassour 127
π π
π6
π½π
π½π
π½π
π½π
π½π
ππ
ππ
π2
ππ
ππ
ππ
ππ
π
![Page 128: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/128.jpg)
Stanford Arm
14.11.2017 J.Nassour 128
π π
π6
π½π
π½π
π½π
π½π
π½π
ππ
ππ
π2
ππ
ππ
ππ
ππ
πππ
![Page 129: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/129.jpg)
Stanford Arm
14.11.2017 J.Nassour 129
π π
π6
π½π
π½π
π½π
π½π
π½π
ππ
ππ
π2
ππ
ππ
ππ
πππ
ππ ππ
![Page 130: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/130.jpg)
Stanford Arm
14.11.2017 J.Nassour 130
π π
π6
π½π
π½π
π½π
π½π
π½π
ππ
ππ
π2
ππ
ππ
ππ
πππ
ππ ππ
ππ
![Page 131: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/131.jpg)
Stanford Arm
14.11.2017 J.Nassour 131
π π
π6
π½π
π½π
π½π
π½π
π½π
ππ
ππ
ππ
ππ
ππ ππ
π2
ππ
ππ ππ
π
ππ
![Page 132: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/132.jpg)
Stanford Arm
14.11.2017 J.Nassour 132
π π
π6
π½π
π½π
π½π
π½π
π½π
ππ
ππ
ππ
ππ
ππ ππ
π2
ππ
ππ ππ
π
ππ
ππ
![Page 133: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/133.jpg)
14.11.2017 J.Nassour 133
Stanford Arm
π ππ πΆπ π π π½π
1 0 β90 Β° 0 π½πβ
2 0 +90 Β° π2 π½πβ
3 0 0 Β°π π
β 0
4 0 β90 Β° 0 π½πβ
5 0 +90 Β° 0 π½πβ
6 0 0 Β° π6 π½πβ
ππ is distance from ππβπ to ππ measured along ππ.πΆπ is angle from ππβπ to ππ measured about ππ. π π is distance from ππβπ to ππ measured along ππβπ.
π½π is angle from ππβπ to ππ measured about ππβπ.
π π
π6
π½π
π½π
π½π
π½π
π½π
ππ
ππ
ππ
ππ
ππ ππ
π2
ππ
ππ ππ
π
ππ
ππ
![Page 134: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/134.jpg)
14.11.2017 J.Nassour 134
Stanford Arm
π ππ πΆπ π π π½π
1 0 β90 Β° 0 π½πβ
2 0 +90 Β° π2 π½πβ
3 0 0 Β°π π
β 0
4 0 β90 Β° 0 π½πβ
5 0 +90 Β° 0 π½πβ
6 0 0 Β° π6 π½πβ
π60 = π΄1π΄2π΄3π΄4π΄5π΄6 =
π11 π12π21 π22
π13 ππ₯π23 ππ¦
π31 π320 0
π33 ππ§0 1
ππ is distance from ππβπ to ππ measured along ππ.πΆπ is angle from ππβπ to ππ measured about ππ. π π is distance from ππβπ to ππ measured along ππβπ.
π½π is angle from ππβπ to ππ measured about ππβπ.
π π
π6
π½π
π½π
π½π
π½π
π½π
ππ
ππ
ππ
ππ
ππ ππ
π2
ππ
ππ ππ
π
ππ
ππ
![Page 135: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/135.jpg)
14.11.2017 J.Nassour 135
Stanford Arm
π ππ πΆπ π π π½π
1 0 β90 Β° 0 π½πβ
2 0 +90 Β° π2 π½πβ
3 0 0 Β°π π
β 0
4 0 β90 Β° 0 π½πβ
5 0 +90 Β° 0 π½πβ
6 0 0 Β° π6 π½πβ
π60 = π΄1π΄2π΄3π΄4π΄5π΄6 =
π11 π12π21 π22
π13 ππ₯π23 ππ¦
π31 π320 0
π33 ππ§0 1
ππ is distance from ππβπ to ππ measured along ππ.πΆπ is angle from ππβπ to ππ measured about ππ. π π is distance from ππβπ to ππ measured along ππβπ.
π½π is angle from ππβπ to ππ measured about ππβπ.
π·π = π»ππ π·π
ππ =?
ππ
π π
π6
π½π
π½π
π½π
π½π
π½π
ππ
ππ
ππ
ππ
ππ ππ
π2
ππ
ππ ππ
π
ππ
ππ
![Page 136: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/136.jpg)
14.11.2017 J.Nassour 136
Stanford Arm
π΄1 =
π1 0π 1 0
βπ 1 0π1 0
0 β10 0
0 00 1
Reminder: π¨π
π΄2 =
π2 0π 2 0
π 2 0βπ2 0
0 10 0
0 π20 1
π΄3 =
1 00 1
0 00 0
0 00 0
1 π30 1
π΄4 =
π4 0π 4 0
βπ 4 0π4 0
0 β10 0
0 00 1
π΄5 =
π5 0π 5 0
π 5 0βπ5 0
0 β10 0
0 00 1
π΄6 =
π6 βπ 6π 6 π6
0 00 0
0 00 0
1 π60 1
π ππ πΆπ π π π½π
1 0 β90 Β° 0 π½πβ
2 0 +90 Β° π2 π½πβ
3 0 0 Β°π π
β 0
4 0 β90 Β° 0 π½πβ
5 0 +90 Β° 0 π½πβ
6 0 0 Β° π6 π½πβ
![Page 137: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/137.jpg)
14.11.2017 J.Nassour 137
Stanford Arm
![Page 138: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/138.jpg)
14.11.2017 J.Nassour 138
Stanford Arm[ s6*(c4*s1 + c1*c2*s4) β c6*(c5*(s1*s4 β c1*c2*c4) + c1*s2*s5), s6*(c5*(s1*s4 β c1*c2*c4) + c1*s2*s5) + c5*(c4*s1 + c1*c2*s4), c1*c5*s2 β s5*(s1*s4 β c1*c2*c4), d3*c1*s2 - d6*(s5*(s1*s4 β c1*c2*c4) β c1*c5*s2) - d2*s1 ][ c6*(c5*(c1*s4 + c2*c4*s1) β s1*s2*s5) β s6*(c1*c4 β c2*s1*s4), - s6*(c5*(c1*s4 + c2*c4*s1) β s1*s2*s5) β c5*(c1*c4 β c2*s1*s4), s5*(c1*s4 + c2*c4*s1) + c5*s1*s2, d2*c1 + d6*(s5*(c1*s4 + c2*c4*s1) + c5*s1*s2) + d3*s1*s2][ -c6*(c2*s5 + c4*c5*s2) β s2*s4*s6, s6*(c2*s5 + c4*c5*s2) β c5*s2*s4, c2*c5 β c4*s2*s5, d6*(c2*c5 β c4*s2*s5) + d3*c2][ 0, 0, 0, 1]
π11 = π 6. (π4. π 1 + π1. π2. π 4)β π6. (π5. (π 1. π 4 β π1. π2. π4) + π1. π 2. π 5)π21 = π6. (π5. (π1. π 4 + π2. π4. π 1)β π 1. π 2. π 5)β π 6. (π1. π4 β π2. π 1. π 4)π31 = βπ6. (π2. π 5 + π4. π5. π 2)β π 2. π 4. π 6
π12 = π 6. (π5. (π 1. π 4 β π1. π2. π4) + π1. π 2. π 5) + π5. (π4. π 1 + π1. π2. π 4)π22 = β π 6. (π5. (π1. π 4 + π2. π4. π 1) β π 1. π 2. π 5) β π5. (π1. π4 β π2. π 1. π 4)π32 = π 6. (π2. π 5 + π4. π5. π 2) β π5. π 2. π 4
π31 = π1. π5. π 2 β π 5. (π 1. π 4 β π1. π2. π4)π32 = π 5. (π1. π 4 + π2. π4. π 1) + π5. π 1. π 2π33 = π2. π5 β π4. π 2. π 5
ππ₯ = π3. π1. π 2 β π6. (π 5. (π 1. π 4 β π1. π2. π4) β π1. π5. π 2) β π2. π 1ππ¦ = π2. π1 + π6. (π 5. (π1. π 4 + π2. π4. π 1) + π5. π 1. π 2) + π3. π 1. π 2ππ§ = π6. (π2. π5 β π4. π 2. π 5) + π3. π2
π π
π6
π½π
π½π
π½π
π½π
π½π
ππ
ππ
ππ
ππ
ππ ππ
π2
ππ
ππ ππ
π
ππ
ππ
![Page 139: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/139.jpg)
14.11.2017 J.Nassour 139
Stanford Arm
π11 = π 6. (π4. π 1 + π1. π2. π 4)β π6. (π5. (π 1. π 4 β π1. π2. π4) + π1. π 2. π 5)π21 = π6. (π5. (π1. π 4 + π2. π4. π 1)β π 1. π 2. π 5)β π 6. (π1. π4 β π2. π 1. π 4)π31 = βπ6. (π2. π 5 + π4. π5. π 2)β π 2. π 4. π 6
π12 = π 6. (π5. (π 1. π 4 β π1. π2. π4) + π1. π 2. π 5) + π5. (π4. π 1 + π1. π2. π 4)π22 = β π 6. (π5. (π1. π 4 + π2. π4. π 1) β π 1. π 2. π 5) β π5. (π1. π4 β π2. π 1. π 4)π32 = π 6. (π2. π 5 + π4. π5. π 2) β π5. π 2. π 4
π31 = π1. π5. π 2 β π 5. (π 1. π 4 β π1. π2. π4)π32 = π 5. (π1. π 4 + π2. π4. π 1) + π5. π 1. π 2π33 = π2. π5 β π4. π 2. π 5
ππ₯ = π3. π1. π 2 β π6. (π 5. (π 1. π 4 β π1. π2. π4) β π1. π5. π 2) β π2. π 1ππ¦ = π2. π1 + π6. (π 5. (π1. π 4 + π2. π4. π 1) + π5. π 1. π 2) + π3. π 1. π 2ππ§ = π6. (π2. π5 β π4. π 2. π 5) + π3. π2
π π
π6
π½π
π½π
π½π
π½π
π½π
ππ
ππ
ππ
ππ
ππ ππ
π2
ππ
ππ ππ
π
ππ
ππ
π60 = π΄1π΄2π΄3π΄4π΄5π΄6 =
π11 π12π21 π22
π13 ππ₯π23 ππ¦
π31 π320 0
π33 ππ§0 1
![Page 140: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/140.jpg)
14.11.2017 J.Nassour 140
Stanford Arm
π11 = π 6. (π4. π 1 + π1. π2. π 4)β π6. (π5. (π 1. π 4 β π1. π2. π4) + π1. π 2. π 5)π21 = π6. (π5. (π1. π 4 + π2. π4. π 1)β π 1. π 2. π 5)β π 6. (π1. π4 β π2. π 1. π 4)π31 = βπ6. (π2. π 5 + π4. π5. π 2)β π 2. π 4. π 6
π12 = π 6. (π5. (π 1. π 4 β π1. π2. π4) + π1. π 2. π 5) + π5. (π4. π 1 + π1. π2. π 4)π22 = β π 6. (π5. (π1. π 4 + π2. π4. π 1) β π 1. π 2. π 5) β π5. (π1. π4 β π2. π 1. π 4)π32 = π 6. (π2. π 5 + π4. π5. π 2) β π5. π 2. π 4
π31 = π1. π5. π 2 β π 5. (π 1. π 4 β π1. π2. π4)π32 = π 5. (π1. π 4 + π2. π4. π 1) + π5. π 1. π 2π33 = π2. π5 β π4. π 2. π 5
ππ₯ = π3. π1. π 2 β π6. (π 5. (π 1. π 4 β π1. π2. π4) β π1. π5. π 2) β π2. π 1ππ¦ = π2. π1 + π6. (π 5. (π1. π 4 + π2. π4. π 1) + π5. π 1. π 2) + π3. π 1. π 2ππ§ = π6. (π2. π5 β π4. π 2. π 5) + π3. π2
π π
π6
π½π
π½π
π½π
π½π
π½π
ππ
ππ
ππ
ππ
ππ ππ
π2
ππ
ππ ππ
π
ππ
ππ
π60 =
π11 π12π21 π22
π13 ππ₯π23 ππ¦
π31 π320 0
π33 ππ§0 1
In the configuration shown, find:
![Page 141: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/141.jpg)
14.11.2017 J.Nassour 141
Stanford Arm
π11 = π 6. (π4. π 1 + π1. π2. π 4)β π6. (π5. (π 1. π 4 β π1. π2. π4) + π1. π 2. π 5)π21 = π6. (π5. (π1. π 4 + π2. π4. π 1)β π 1. π 2. π 5)β π 6. (π1. π4 β π2. π 1. π 4)π31 = βπ6. (π2. π 5 + π4. π5. π 2)β π 2. π 4. π 6
π12 = π 6. (π5. (π 1. π 4 β π1. π2. π4) + π1. π 2. π 5) + π5. (π4. π 1 + π1. π2. π 4)π22 = β π 6. (π5. (π1. π 4 + π2. π4. π 1) β π 1. π 2. π 5) β π5. (π1. π4 β π2. π 1. π 4)π32 = π 6. (π2. π 5 + π4. π5. π 2) β π5. π 2. π 4
π31 = π1. π5. π 2 β π 5. (π 1. π 4 β π1. π2. π4)π32 = π 5. (π1. π 4 + π2. π4. π 1) + π5. π 1. π 2π33 = π2. π5 β π4. π 2. π 5
ππ₯ = π3. π1. π 2 β π6. (π 5. (π 1. π 4 β π1. π2. π4) β π1. π5. π 2) β π2. π 1ππ¦ = π2. π1 + π6. (π 5. (π1. π 4 + π2. π4. π 1) + π5. π 1. π 2) + π3. π 1. π 2ππ§ = π6. (π2. π5 β π4. π 2. π 5) + π3. π2
π π
π6
π½π
π½π
π½π
π½π
π½π
ππ
ππ
ππ
ππ
ππ ππ
π2
ππ
ππ ππ
π
ππ
ππ
π60 =
π11 π12π21 π22
π13 ππ₯π23 ππ¦
π31 π320 0
π33 ππ§0 1
In the configuration shown, find:
![Page 142: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/142.jpg)
14.11.2017 J.Nassour 142
Stanford Arm
π11 = π 6. (π4. π 1 + π1. π2. π 4)β π6. (π5. (π 1. π 4 β π1. π2. π4) + π1. π 2. π 5)π21 = π6. (π5. (π1. π 4 + π2. π4. π 1)β π 1. π 2. π 5)β π 6. (π1. π4 β π2. π 1. π 4)π31 = βπ6. (π2. π 5 + π4. π5. π 2)β π 2. π 4. π 6
π12 = π 6. (π5. (π 1. π 4 β π1. π2. π4) + π1. π 2. π 5) + π5. (π4. π 1 + π1. π2. π 4)π22 = β π 6. (π5. (π1. π 4 + π2. π4. π 1) β π 1. π 2. π 5) β π5. (π1. π4 β π2. π 1. π 4)π32 = π 6. (π2. π 5 + π4. π5. π 2) β π5. π 2. π 4
π31 = π1. π5. π 2 β π 5. (π 1. π 4 β π1. π2. π4)π32 = π 5. (π1. π 4 + π2. π4. π 1) + π5. π 1. π 2π33 = π2. π5 β π4. π 2. π 5
ππ₯ = π3. π1. π 2 β π6. (π 5. (π 1. π 4 β π1. π2. π4) β π1. π5. π 2) β π2. π 1ππ¦ = π2. π1 + π6. (π 5. (π1. π 4 + π2. π4. π 1) + π5. π 1. π 2) + π3. π 1. π 2ππ§ = π6. (π2. π5 β π4. π 2. π 5) + π3. π2
π π
π6
π½π
π½π
π½π
π½π
π½π
ππ
ππ
ππ
ππ
ππ ππ
π2
ππ
ππ ππ
π
ππ
ππ
π60 =
π11 π12π21 π22
π13 ππ₯π23 ππ¦
π31 π320 0
π33 ππ§0 1
In the configuration shown, find:
![Page 143: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/143.jpg)
14.11.2017 J.Nassour 143
Stanford Arm
π11 = π 6. (π4. π 1 + π1. π2. π 4)β π6. (π5. (π 1. π 4 β π1. π2. π4) + π1. π 2. π 5)π21 = π6. (π5. (π1. π 4 + π2. π4. π 1)β π 1. π 2. π 5)β π 6. (π1. π4 β π2. π 1. π 4)π31 = βπ6. (π2. π 5 + π4. π5. π 2)β π 2. π 4. π 6
π12 = π 6. (π5. (π 1. π 4 β π1. π2. π4) + π1. π 2. π 5) + π5. (π4. π 1 + π1. π2. π 4)π22 = β π 6. (π5. (π1. π 4 + π2. π4. π 1) β π 1. π 2. π 5) β π5. (π1. π4 β π2. π 1. π 4)π32 = π 6. (π2. π 5 + π4. π5. π 2) β π5. π 2. π 4
π31 = π1. π5. π 2 β π 5. (π 1. π 4 β π1. π2. π4)π32 = π 5. (π1. π 4 + π2. π4. π 1) + π5. π 1. π 2π33 = π2. π5 β π4. π 2. π 5
ππ₯ = π3. π1. π 2 β π6. (π 5. (π 1. π 4 β π1. π2. π4) β π1. π5. π 2) β π2. π 1ππ¦ = π2. π1 + π6. (π 5. (π1. π 4 + π2. π4. π 1) + π5. π 1. π 2) + π3. π 1. π 2ππ§ = π6. (π2. π5 β π4. π 2. π 5) + π3. π2
π π
π6
π½π
π½π
π½π
π½π
π½π
ππ
ππ
ππ
ππ
ππ ππ
π2
ππ
ππ ππ
π
ππ
ππ
π60 =
π11 π12π21 π22
π13 ππ₯π23 ππ¦
π31 π320 0
π33 ππ§0 1
In the configuration shown, find:
![Page 144: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/144.jpg)
14.11.2017 J.Nassour 144
Stanford Arm
π11 = π 6. (π4. π 1 + π1. π2. π 4)β π6. (π5. (π 1. π 4 β π1. π2. π4) + π1. π 2. π 5)π21 = π6. (π5. (π1. π 4 + π2. π4. π 1)β π 1. π 2. π 5)β π 6. (π1. π4 β π2. π 1. π 4)π31 = βπ6. (π2. π 5 + π4. π5. π 2)β π 2. π 4. π 6
π12 = π 6. (π5. (π 1. π 4 β π1. π2. π4) + π1. π 2. π 5) + π5. (π4. π 1 + π1. π2. π 4)π22 = β π 6. (π5. (π1. π 4 + π2. π4. π 1) β π 1. π 2. π 5) β π5. (π1. π4 β π2. π 1. π 4)π32 = π 6. (π2. π 5 + π4. π5. π 2) β π5. π 2. π 4
π31 = π1. π5. π 2 β π 5. (π 1. π 4 β π1. π2. π4)π32 = π 5. (π1. π 4 + π2. π4. π 1) + π5. π 1. π 2π33 = π2. π5 β π4. π 2. π 5
ππ₯ = π3. π1. π 2 β π6. (π 5. (π 1. π 4 β π1. π2. π4) β π1. π5. π 2) β π2. π 1ππ¦ = π2. π1 + π6. (π 5. (π1. π 4 + π2. π4. π 1) + π5. π 1. π 2) + π3. π 1. π 2ππ§ = π6. (π2. π5 β π4. π 2. π 5) + π3. π2
π π
π6
π½π
π½π
π½π
π½π
π½π
ππ
ππ
ππ
ππ
ππ ππ
π2
ππ
ππ ππ
π
ππ
ππ
π60 =
π11 π12π21 π22
π13 ππ₯π23 ππ¦
π31 π320 0
π33 ππ§0 1
In the configuration shown, find:
![Page 145: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/145.jpg)
14.11.2017 J.Nassour 145
Stanford Arm
π΄1 =
π1 0π 1 0
βπ 1 0π1 0
0 β10 0
0 00 1
Reminder: π¨π
π΄2 =
π2 0π 2 0
π 2 0βπ2 0
0 10 0
0 π20 1
π΄3 =
1 00 1
0 00 0
0 00 0
1 π30 1
π΄4 =
π4 0π 4 0
βπ 4 0π4 0
0 β10 0
0 00 1
π΄5 =
π5 0π 5 0
π 5 0βπ5 0
0 β10 0
0 00 1
π΄6 =
π6 βπ 6π 6 π6
0 00 0
0 00 0
1 π60 1
π ππ πΆπ π π π½π
1 0 β90 Β° 0 π½πβ
2 0 +90 Β° π2 π½πβ
3 0 0 Β°π π
β 0
4 0 β90 Β° 0 π½πβ
5 0 +90 Β° 0 π½πβ
6 0 0 Β° π6 π½πβ
![Page 146: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/146.jpg)
14.11.2017 J.Nassour 146
Stanford Arm
![Page 147: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/147.jpg)
14.11.2017 J.Nassour 147
Stanford Arm
π π
π6
π½π
π½π
π½π
π½π
π½π
ππ
ππ
ππ
ππ
ππ ππ
π2
ππ
ππ ππ
π
ππ
ππ
π11 = β π6 π5 π 1π 4 β π1π2π4 + π1π 2π 5 β π 6 π4π 1 + π1π2π 4π21 = π6 π5 π1π 4 + π2π4π 1 β π 1π 2π 5 + π 6 π1π4 β π2π 1π 4π31 = π 2π 4π 6 β π6 π2π 5 + π4π5π 2
π12 = π 6 π5 π 1π 4 β π1π2π4 + π1π 2π 5 β π6 π4π 1 + π1π2π 4π22 = π6 π1π4 β π2π 1π 4 β π 6 π5 π1π 4 + π2π4π 1 β π 1π 2π 5π32 = π 6 π2π 5 + π4π5π 2 + π6π 2π 4
π13 = π1π5π 2 β π 5 π 1π 4 β π1π2π4π23 = π 5 π1π 4 + π2π4π 1 + π5π 1π 2π33 = π2π5 β π4π 2π 5
ππ₯ = π3π1π 2 β π6 π 5 π 1π 4 β π1π2π4 β π1π5π 2 β π2π 1ππ¦ = π2π1 + π6 π 5 π1π 4 + π2π4π 1 + π5π 1π 2 + π3π 1π 2ππ§ = π6 π2π5 β π4π 2π 5 + π3π2
![Page 148: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/148.jpg)
π11 = β π6 π5 π 1π 4 β π1π2π4 + π1π 2π 5 β π 6 π4π 1 + π1π2π 4π21 = π6 π5 π1π 4 + π2π4π 1 β π 1π 2π 5 + π 6 π1π4 β π2π 1π 4π31 = π 2π 4π 6 β π6 π2π 5 + π4π5π 2
π12 = π 6 π5 π 1π 4 β π1π2π4 + π1π 2π 5 β π6 π4π 1 + π1π2π 4π22 = π6 π1π4 β π2π 1π 4 β π 6 π5 π1π 4 + π2π4π 1 β π 1π 2π 5π32 = π 6 π2π 5 + π4π5π 2 + π6π 2π 4
π13 = π1π5π 2 β π 5 π 1π 4 β π1π2π4π23 = π 5 π1π 4 + π2π4π 1 + π5π 1π 2π33 = π2π5 β π4π 2π 5
ππ₯ = π3π1π 2 β π6 π 5 π 1π 4 β π1π2π4 β π1π5π 2 β π2π 1ππ¦ = π2π1 + π6 π 5 π1π 4 + π2π4π 1 + π5π 1π 2 + π3π 1π 2ππ§ = π6 π2π5 β π4π 2π 5 + π3π2
14.11.2017 J.Nassour 148
Stanford Arm
π π
π6
π½π
π½π
π½π
π½π
π½π
ππ
ππ
ππ
ππ
ππ ππ
π2
ππ
ππ ππ
π
ππ
ππ
![Page 149: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/149.jpg)
14.11.2017 J.Nassour 149
Stanford Arm
π π
π6
π½π
π½π
π½π
π½π
π½π
ππ
ππ
ππ
ππ
ππ ππ
π2
ππ
ππ ππ
π
ππ
ππ
π11 = β π6 π5 π 1π 4 β π1π2π4 + π1π 2π 5 β π 6 π4π 1 + π1π2π 4π21 = π6 π5 π1π 4 + π2π4π 1 β π 1π 2π 5 + π 6 π1π4 β π2π 1π 4π31 = π 2π 4π 6 β π6 π2π 5 + π4π5π 2
π12 = π 6 π5 π 1π 4 β π1π2π4 + π1π 2π 5 β π6 π4π 1 + π1π2π 4π22 = π6 π1π4 β π2π 1π 4 β π 6 π5 π1π 4 + π2π4π 1 β π 1π 2π 5π32 = π 6 π2π 5 + π4π5π 2 + π6π 2π 4
π13 = π1π5π 2 β π 5 π 1π 4 β π1π2π4π23 = π 5 π1π 4 + π2π4π 1 + π5π 1π 2π33 = π2π5 β π4π 2π 5
ππ₯ = π3π1π 2 β π6 π 5 π 1π 4 β π1π2π4 β π1π5π 2 β π2π 1ππ¦ = π2π1 + π6 π 5 π1π 4 + π2π4π 1 + π5π 1π 2 + π3π 1π 2ππ§ = π6 π2π5 β π4π 2π 5 + π3π2
![Page 150: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/150.jpg)
14.11.2017 J.Nassour 150
Stanford Arm
π π
π6
π½π
π½π
π½π
π½π
π½π
ππ
ππ
ππ
ππ
ππ ππ
π2
ππ
ππ ππ
π
ππ
ππ
π11 = β π6 π5 π 1π 4 β π1π2π4 + π1π 2π 5 β π 6 π4π 1 + π1π2π 4π21 = π6 π5 π1π 4 + π2π4π 1 β π 1π 2π 5 + π 6 π1π4 β π2π 1π 4π31 = π 2π 4π 6 β π6 π2π 5 + π4π5π 2
π12 = π 6 π5 π 1π 4 β π1π2π4 + π1π 2π 5 β π6 π4π 1 + π1π2π 4π22 = π6 π1π4 β π2π 1π 4 β π 6 π5 π1π 4 + π2π4π 1 β π 1π 2π 5π32 = π 6 π2π 5 + π4π5π 2 + π6π 2π 4
π13 = π1π5π 2 β π 5 π 1π 4 β π1π2π4π23 = π 5 π1π 4 + π2π4π 1 + π5π 1π 2π33 = π2π5 β π4π 2π 5
ππ₯ = π3π1π 2 β π6 π 5 π 1π 4 β π1π2π4 β π1π5π 2 β π2π 1ππ¦ = π2π1 + π6 π 5 π1π 4 + π2π4π 1 + π5π 1π 2 + π3π 1π 2ππ§ = π6 π2π5 β π4π 2π 5 + π3π2
![Page 151: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/151.jpg)
PUMA 260
14.11.2017 J.Nassour 151
π½π
π½π
π½π
π½π
π½π
![Page 152: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/152.jpg)
14.11.2017 J.Nassour 152
PUMA 260
π½π
π½π
π½π
π½π
π½ππ½π
![Page 153: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/153.jpg)
14.11.2017 J.Nassour 153
PUMA 260
π½π
π½π
π½π
π½π
π½ππ½π
ππ
ππππ
![Page 154: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/154.jpg)
14.11.2017 J.Nassour 154
PUMA 260
π½π
π½π
π½π
π½π
π½ππ½π
ππ
ππππ
ππ
ππ
ππ
![Page 155: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/155.jpg)
14.11.2017 J.Nassour 155
PUMA 260
π½π
π½π
π½π
π½π
π½ππ½π
ππ
ππππ
ππ
ππ
ππ
ππ
ππ
ππ
π π
ππ
![Page 156: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/156.jpg)
14.11.2017 J.Nassour 156
PUMA 260
π½π
π½π
π½π
π½π
π½ππ½π
ππ
ππππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
π π
ππ
ππ
![Page 157: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/157.jpg)
14.11.2017 J.Nassour 157
PUMA 260
π½π
π½π
π½π
π½π
π½ππ½π
ππ
ππππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππππ
ππ
π π
ππ
π π
ππ
![Page 158: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/158.jpg)
14.11.2017 J.Nassour 158
PUMA 260
π½π
π½π
π½π
π½π
π½ππ½π
ππ
ππππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππππ
ππ
ππ
ππ
ππ
π π
ππ
π π
ππ
![Page 159: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/159.jpg)
14.11.2017 J.Nassour 159
PUMA 260
π½π
π½π
π½π
π½π
π½ππ½π
ππ
ππππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
π π
ππ
π π
ππ
π π
![Page 160: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/160.jpg)
14.11.2017 J.Nassour 160
PUMA 260
π½π
π½π
π½π
π½π
π½ππ½π
ππ
ππππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
π π
ππ
π π
ππ
π π
π ππ πΆπ π π π½π
1 0 β90 Β° 0 π½πβ
2 π2 0 Β° π2 π½πβ
3 π3 90 Β° 0 π½πβ
4 0 β90 Β° π4 π½πβ
5 0 +90 Β° 0 π½πβ
6 0 0 Β° π6 π½πβ
ππ is distance from ππβπ to ππ measured along ππ.πΆπ is angle from ππβπ to ππ measured about ππ. π π is distance from ππβπ to ππ measured along ππβπ.
π½π is angle from ππβπ to ππ measured about ππβπ.
![Page 161: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/161.jpg)
14.11.2017 J.Nassour 161
PUMA 260
π½π
π½π
π½π
π½π
π½ππ½π
ππ
ππππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
π π
ππ
π π
ππ
π π
π ππ πΆπ π π π½π
1 0 β90 Β° 0 ππ
2 π2 0 Β° π2 π
3 π3 90 Β° 0 ππ
4 0 β90 Β° π4 π
5 0 +90 Β° 0 π
6 0 0 Β° π6 π
ππ is distance from ππβπ to ππ measured along ππ.πΆπ is angle from ππβπ to ππ measured about ππ. π π is distance from ππβπ to ππ measured along ππβπ.
π½π is angle from ππβπ to ππ measured about ππβπ.
In the configuration shown, find π½π?
![Page 162: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/162.jpg)
14.11.2017 J.Nassour 162
PUMA 260π ππ πΆπ π π π½π
1 0 β90 Β° 0 π½πβ
2 π2 0 Β° π2 π½πβ
3 π3 90 Β° 0 π½πβ
4 0 β90 Β° π4 π½πβ
5 0 +90 Β° 0 π½πβ
6 0 0 Β° π6 π½πβ
Reminder: π¨π
![Page 163: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/163.jpg)
14.11.2017 J.Nassour 163
r11 = β s6 c4s1 β s4 c1s2s3 β c1c2c3 β c6 c5 s1s4 + c4 c1s2s3 β c1c2c3 + s5 c1c2s3 + c1c3s2
π12 = π 6 π5 π 1π 4 + π4 π1π 2π 3 β π1π2π3 + π 5 π1π2π 3 + π1π3π 2 β π6 π4π 1 β π 4 π1π 2π 3 β π1π2π3
r13 = c5 c1c2s3 + c1c3s2 β s5 s1s4 + c4 c1s2s3 β c1c2c3
ππ₯ = π4 π1π2π 3 + π1π3π 2 β π2π 1 β π6 π 5 π 1π 4 + π4 π1π 2π 3 β π1π2π3 β π5 π1π2π 3 + π1π3π 2 + π2π1π2 + π3π1π2π3 β π3π1π 2π 3
π21 = π 6 π1π4 + π 4 π 1π 2π 3 β π2π3π 1 + π6 π5 π1π 4 β π4 π 1π 2π 3 β π2π3π 1 β π 5 π2π 1π 3 + π3π 1π 2
π22 = π6 π1π4 + π 4 π 1π 2π 3 β π2π3π 1 β π 6 π5 π1π 4 β π4 π 1π 2π 3 β π2π3π 1 β π 5 π2π 1π 3 + π3π 1π 2
π23 = π 5 π1π 4 β π4 π 1π 2π 3 β π2π3π 1 + π5 π2π 1π 3 + π3π 1π 2
ππ¦ = π6 π 5 π1π 4 β π4 π 1π 2π 3 β π2π3π 1 + π5 π2π 1π 3 + π3π 1π 2 + π4 π2π 1π 3 + π3π 1π 2 + π2π1 + π2π2π 1 + π3π2π3π 1 β π3π 1π 2π 3
π31 = π 4π 6 π2π 3 + π3π 2 β π6 π 5 π2π3 β π 2π 3 + π4π5 π2π 3 + π3π 2π32 = π 6 π 5 π2π3 β π 2π 3 + π4π5 π2π 3 + π3π 2 + π6π 4 π2π 3 + π3π 2π33 = π5 π2π3 β π 2π 3 β π4π 5 π2π 3 + π3π 2ππ§ = π4 π2π3 β π 2π 3 β π2π 2 + π6 π5 π2π3 β π 2π 3 β π4π 5 π2π 3 + π3π 2 β π3π2π 3 β π3π3π 2
PUMA 260
![Page 164: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/164.jpg)
14.11.2017 J.Nassour 164
r11 = β s6 c4s1 β s4 c1s2s3 β c1c2c3 β c6 c5 s1s4 + c4 c1s2s3 β c1c2c3 + s5 c1c2s3 + c1c3s2
π12 = π 6 π5 π 1π 4 + π4 π1π 2π 3 β π1π2π3 + π 5 π1π2π 3 + π1π3π 2 β π6 π4π 1 β π 4 π1π 2π 3 β π1π2π3
r13 = c5 c1c2s3 + c1c3s2 β s5 s1s4 + c4 c1s2s3 β c1c2c3
ππ₯ = π4 π1π2π 3 + π1π3π 2 β π2π 1 β π6 π 5 π 1π 4 + π4 π1π 2π 3 β π1π2π3 β π5 π1π2π 3 + π1π3π 2 + π2π1π2 + π3π1π2π3 β π3π1π 2π 3
π21 = π 6 π1π4 + π 4 π 1π 2π 3 β π2π3π 1 + π6 π5 π1π 4 β π4 π 1π 2π 3 β π2π3π 1 β π 5 π2π 1π 3 + π3π 1π 2
π22 = π6 π1π4 + π 4 π 1π 2π 3 β π2π3π 1 β π 6 π5 π1π 4 β π4 π 1π 2π 3 β π2π3π 1 β π 5 π2π 1π 3 + π3π 1π 2
π23 = π 5 π1π 4 β π4 π 1π 2π 3 β π2π3π 1 + π5 π2π 1π 3 + π3π 1π 2
ππ¦ = π6 π 5 π1π 4 β π4 π 1π 2π 3 β π2π3π 1 + π5 π2π 1π 3 + π3π 1π 2 + π4 π2π 1π 3 + π3π 1π 2 + π2π1 + π2π2π 1 + π3π2π3π 1 β π3π 1π 2π 3
π31 = π 4π 6 π2π 3 + π3π 2 β π6 π 5 π2π3 β π 2π 3 + π4π5 π2π 3 + π3π 2π32 = π 6 π 5 π2π3 β π 2π 3 + π4π5 π2π 3 + π3π 2 + π6π 4 π2π 3 + π3π 2π33 = π5 π2π3 β π 2π 3 β π4π 5 π2π 3 + π3π 2ππ§ = π4 π2π3 β π 2π 3 β π2π 2 + π6 π5 π2π3 β π 2π 3 β π4π 5 π2π 3 + π3π 2 β π3π2π 3 β π3π3π 2
PUMA 260
π½π
π½π
π½π
π½π
π½ππ½π
ππ
ππππ
ππ
ππ
ππ
![Page 165: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/165.jpg)
14.11.2017 J.Nassour 165
r11 = β s6 c4s1 β s4 c1s2s3 β c1c2c3 β c6 c5 s1s4 + c4 c1s2s3 β c1c2c3 + s5 c1c2s3 + c1c3s2
π12 = π 6 π5 π 1π 4 + π4 π1π 2π 3 β π1π2π3 + π 5 π1π2π 3 + π1π3π 2 β π6 π4π 1 β π 4 π1π 2π 3 β π1π2π3
r13 = c5 c1c2s3 + c1c3s2 β s5 s1s4 + c4 c1s2s3 β c1c2c3
ππ₯ = π4 π1π2π 3 + π1π3π 2 β π2π 1 β π6 π 5 π 1π 4 + π4 π1π 2π 3 β π1π2π3 β π5 π1π2π 3 + π1π3π 2 + π2π1π2 + π3π1π2π3 β π3π1π 2π 3
π21 = π 6 π1π4 + π 4 π 1π 2π 3 β π2π3π 1 + π6 π5 π1π 4 β π4 π 1π 2π 3 β π2π3π 1 β π 5 π2π 1π 3 + π3π 1π 2
π22 = π6 π1π4 + π 4 π 1π 2π 3 β π2π3π 1 β π 6 π5 π1π 4 β π4 π 1π 2π 3 β π2π3π 1 β π 5 π2π 1π 3 + π3π 1π 2
π23 = π 5 π1π 4 β π4 π 1π 2π 3 β π2π3π 1 + π5 π2π 1π 3 + π3π 1π 2
ππ¦ = π6 π 5 π1π 4 β π4 π 1π 2π 3 β π2π3π 1 + π5 π2π 1π 3 + π3π 1π 2 + π4 π2π 1π 3 + π3π 1π 2 + π2π1 + π2π2π 1 + π3π2π3π 1 β π3π 1π 2π 3
π31 = π 4π 6 π2π 3 + π3π 2 β π6 π 5 π2π3 β π 2π 3 + π4π5 π2π 3 + π3π 2π32 = π 6 π 5 π2π3 β π 2π 3 + π4π5 π2π 3 + π3π 2 + π6π 4 π2π 3 + π3π 2π33 = π5 π2π3 β π 2π 3 β π4π 5 π2π 3 + π3π 2ππ§ = π4 π2π3 β π 2π 3 β π2π 2 + π6 π5 π2π3 β π 2π 3 β π4π 5 π2π 3 + π3π 2 β π3π2π 3 β π3π3π 2
PUMA 260
π½π
π½π
π½π
π½π
π½ππ½π
ππ
ππππ
ππ
ππ
ππ
![Page 166: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/166.jpg)
14.11.2017 J.Nassour 166
PUMA 260
π½π
π½π
π½π
π½π
π½ππ½π
ππ
ππππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
π π
ππ
π π
ππ
π π
π ππ πΆπ π π π½π
1 0 β90 Β° 0 ππ
2 π2 0 Β° π2 π
3 π3 90 Β° 0 ππ
4 0 β90 Β° π4 π
5 0 +90 Β° 0 π
6 0 0 Β° π6 π
ππ is distance from ππβπ to ππ measured along ππ.πΆπ is angle from ππβπ to ππ measured about ππ. π π is distance from ππβπ to ππ measured along ππβπ.
π½π is angle from ππβπ to ππ measured about ππβπ.
![Page 167: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/167.jpg)
14.11.2017 J.Nassour 167
r11 = β s6 c4s1 β s4 c1s2s3 β c1c2c3 β c6 c5 s1s4 + c4 c1s2s3 β c1c2c3 + s5 c1c2s3 + c1c3s2
π12 = π 6 π5 π 1π 4 + π4 π1π 2π 3 β π1π2π3 + π 5 π1π2π 3 + π1π3π 2 β π6 π4π 1 β π 4 π1π 2π 3 β π1π2π3
r13 = c5 c1c2s3 + c1c3s2 β s5 s1s4 + c4 c1s2s3 β c1c2c3
ππ₯ = π4 π1π2π 3 + π1π3π 2 β π2π 1 β π6 π 5 π 1π 4 + π4 π1π 2π 3 β π1π2π3 β π5 π1π2π 3 + π1π3π 2 + π2π1π2 + π3π1π2π3 β π3π1π 2π 3
π21 = π 6 π1π4 + π 4 π 1π 2π 3 β π2π3π 1 + π6 π5 π1π 4 β π4 π 1π 2π 3 β π2π3π 1 β π 5 π2π 1π 3 + π3π 1π 2
π22 = π6 π1π4 + π 4 π 1π 2π 3 β π2π3π 1 β π 6 π5 π1π 4 β π4 π 1π 2π 3 β π2π3π 1 β π 5 π2π 1π 3 + π3π 1π 2
π23 = π 5 π1π 4 β π4 π 1π 2π 3 β π2π3π 1 + π5 π2π 1π 3 + π3π 1π 2
ππ¦ = π6 π 5 π1π 4 β π4 π 1π 2π 3 β π2π3π 1 + π5 π2π 1π 3 + π3π 1π 2 + π4 π2π 1π 3 + π3π 1π 2 + π2π1 + π2π2π 1 + π3π2π3π 1 β π3π 1π 2π 3
π31 = π 4π 6 π2π 3 + π3π 2 β π6 π 5 π2π3 β π 2π 3 + π4π5 π2π 3 + π3π 2π32 = π 6 π 5 π2π3 β π 2π 3 + π4π5 π2π 3 + π3π 2 + π6π 4 π2π 3 + π3π 2π33 = π5 π2π3 β π 2π 3 β π4π 5 π2π 3 + π3π 2ππ§ = π4 π2π3 β π 2π 3 β π2π 2 + π6 π5 π2π3 β π 2π 3 β π4π 5 π2π 3 + π3π 2 β π3π2π 3 β π3π3π 2
PUMA 260
π½π
π½π
π½π
π½π
π½ππ½π
ππ
ππππ
ππ
ππ
ππ
![Page 168: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/168.jpg)
14.11.2017 J.Nassour 168
NAO Left Arm
![Page 169: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/169.jpg)
14.11.2017 J.Nassour 169
NAO Zero Position
Provided by Aldebaran Robotics
The torso is the point where all the kinematic chains begin and is located at the center of the NAO body.
![Page 170: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/170.jpg)
14.11.2017 J.Nassour 170
NAO Zero Position
![Page 171: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/171.jpg)
14.11.2017 J.Nassour 171
NAO Left Arm
π½π
π½π
![Page 172: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/172.jpg)
14.11.2017 J.Nassour 172
NAO Left Arm
π½π
π½π
π½π
π½π
![Page 173: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/173.jpg)
14.11.2017 J.Nassour 173
NAO Left Arm
π½π
π½π
π½π
π½π
π½π
![Page 174: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/174.jpg)
14.11.2017 J.Nassour 174
NAO Left Arm
π½π
π½π
π½π
π½π
π½π
ππ»
ππ»ππ»
![Page 175: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/175.jpg)
14.11.2017 J.Nassour 175
NAO Left Arm
π½π
π½π
π½π
π½π
π½π
ππ»
ππ»ππ»
ππππ
ππ
![Page 176: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/176.jpg)
14.11.2017 J.Nassour 176
NAO Left Arm
π½π
π½π
π½π
π½π
π½π
ππ»
ππ»ππ»
ππππ
ππ
ππ
ππ
ππ
![Page 177: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/177.jpg)
14.11.2017 J.Nassour 177
NAO Left Arm
π½π
π½π
π½π
π½π
π½π
ππ»
ππ»ππ»
ππππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
![Page 178: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/178.jpg)
14.11.2017 J.Nassour 178
NAO Left Arm
π½π
π½π
π½π
π½π
π½π
ππ»
ππ»ππ»
ππππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
![Page 179: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/179.jpg)
14.11.2017 J.Nassour 179
NAO Left Arm
π½π
π½π
π½π
π½π
π½π
ππ»
ππ»ππ»
ππππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
![Page 180: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/180.jpg)
14.11.2017 J.Nassour 180
NAO Left Arm
π½π
π½π
π½π
π½π
π½π
ππ»
ππ»ππ»
ππππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππππ
![Page 181: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/181.jpg)
14.11.2017 J.Nassour 181
π½π
π½π
π½π
π½π
π½π
ππ»
ππ»ππ»
ππππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
NAO Left Armπ ππ πΆπ π π π½π
0 π 0π΅π΄ππΈ (0, πβππ’ππππππππ ππ‘π, πβππ’ππππππππ ππ‘π)
1 0 90 Β° 0 π½πβ
2 π2 90 Β° 0 π
π+ π½π
β
3 0 β90 Β° π3 π½πβ
4 0 +90 Β° 0 π½πβ
5 π5 0 Β° π5π
π+ π½π
β
ππ is distance from ππβπ to ππ measured along ππ.πΆπ is angle from ππβπ to ππ measured about ππ. π π is distance from ππβπ to ππ measured along ππβπ.
π½π is angle from ππβπ to ππ measured about ππβπ.
ππ
ππππ
![Page 182: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/182.jpg)
14.11.2017 J.Nassour 182
π½π
π½π
π½π
π½π
π½π
ππ»
ππ»ππ»
ππππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
ππ
NAO Left Armπ ππ πΆπ π π π½π
0 π 0π΅π΄ππΈ (0, πβππ’ππππππππ ππ‘π, πβππ’ππππππππ ππ‘π)
1 0 90 Β° 0 π½πβ
2 π2 90 Β° 0 π
π+ π½π
β
3 0 β90 Β° π3 π½πβ
4 0 +90 Β° 0 π½πβ
5 π5 0 Β° π5π
π+ π½π
β
ππ is distance from ππβπ to ππ measured along ππ.πΆπ is angle from ππβπ to ππ measured about ππ. π π is distance from ππβπ to ππ measured along ππβπ.
π½π is angle from ππβπ to ππ measured about ππβπ.
π» ππ©π¨πΊπ¬ = ?
ππ
ππππ
![Page 183: Forward Kinematics - TU Chemnitz](https://reader030.vdocuments.site/reader030/viewer/2022012717/61af4ef36212e30e733f8bd9/html5/thumbnails/183.jpg)
14.11.2017 J.Nassour 183