Forward Kinematics - TU Chemnitz · Forward Kinematics Determine the position and orientation of...
Transcript of Forward Kinematics - TU Chemnitz · Forward Kinematics Determine the position and orientation of...
![Page 1: Forward Kinematics - TU Chemnitz · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/1.jpg)
Forward Kinematics
Dr.-Ing. John Nassour
Artificial Intelligence & Neuro Cognitive Systems Fakultät für Informatik
Serial link manipulators
01.11.2016 J.Nassour 1
![Page 2: Forward Kinematics - TU Chemnitz · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/2.jpg)
Suggested literature
• Robot Modeling and Control• Robotics: Modelling, Planning and Control
01.11.2016 J.Nassour 2
![Page 3: Forward Kinematics - TU Chemnitz · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/3.jpg)
Reminder: Right Hand Rules
01.11.2016
Cross product
J.Nassour 3
![Page 4: Forward Kinematics - TU Chemnitz · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/4.jpg)
Reminder: Right Hand Rules
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/5.jpg)
Reminder: Right Hand Rules
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/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.
01.11.2016 J.Nassour 6
![Page 7: Forward Kinematics - TU Chemnitz · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/7.jpg)
Forward Kinematics
Determine the position and orientation of theend-effector given the values for the jointvariables of the robot.
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/8.jpg)
Robot Manipulators
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/9.jpg)
The Workspace Of A Robot
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/10.jpg)
Robot Manipulators
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/11.jpg)
Articulated Manipulators (RRR)
01.11.2016 J.Nassour 11
![Page 12: Forward Kinematics - TU Chemnitz · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/12.jpg)
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/13.jpg)
01.11.2016
Elbow Manipulator (RRR)
Workspace
Structure
J.Nassour 13
![Page 14: Forward Kinematics - TU Chemnitz · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/14.jpg)
Spherical Manipulator
01.11.2016
The Stanford Arm
J.Nassour 14
![Page 15: Forward Kinematics - TU Chemnitz · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/15.jpg)
Spherical Manipulator RRP
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/16.jpg)
Spherical Manipulator RRP
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/17.jpg)
Spherical Manipulator RRR
01.11.2016
Workspace?
Structure
J.Nassour 17
![Page 18: Forward Kinematics - TU Chemnitz · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/18.jpg)
SCARA Manipulator
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/19.jpg)
SCARA Manipulator
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/20.jpg)
Cylindrical Manipulator
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/21.jpg)
Cylindrical Manipulator
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/22.jpg)
The Cartesian Manipulators
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/23.jpg)
The Cartesian Manipulators
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/24.jpg)
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/25.jpg)
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/26.jpg)
Generalized Coordinates
A set of independent configuration parameters
𝟔 𝒑𝒂𝒓𝒂𝒎𝒆𝒕𝒆𝒓𝒔/𝒍𝒊𝒏𝒌 𝟑 𝒑𝒐𝒔𝒊𝒕𝒊𝒐𝒏𝒔𝟑 𝒐𝒓𝒊𝒆𝒏𝒕𝒂𝒕𝒊𝒐𝒏𝒔
01.11.2016 J.Nassour 26
![Page 27: Forward Kinematics - TU Chemnitz · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/27.jpg)
Generalized Coordinates
A set of independent configuration parameters
𝟔 𝒑𝒂𝒓𝒂𝒎𝒆𝒕𝒆𝒓𝒔/𝒍𝒊𝒏𝒌 𝟑 𝒑𝒐𝒔𝒊𝒕𝒊𝒐𝒏𝒔𝟑 𝒐𝒓𝒊𝒆𝒏𝒕𝒂𝒕𝒊𝒐𝒏𝒔
01.11.2016
𝐿𝑖𝑛𝑘 1
Base
𝐿𝑖𝑛𝑘 2
𝐿𝑖𝑛𝑘 𝑛
6n parameters for n moving links
J.Nassour 27
![Page 28: Forward Kinematics - TU Chemnitz · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/28.jpg)
Generalized Coordinates
A set of independent configuration parameters
𝟔 𝒑𝒂𝒓𝒂𝒎𝒆𝒕𝒆𝒓𝒔/𝒍𝒊𝒏𝒌 𝟑 𝒑𝒐𝒔𝒊𝒕𝒊𝒐𝒏𝒔𝟑 𝒐𝒓𝒊𝒆𝒏𝒕𝒂𝒕𝒊𝒐𝒏𝒔
01.11.2016
𝐿𝑖𝑛𝑘 1
Base
𝐿𝑖𝑛𝑘 2
𝐿𝑖𝑛𝑘 𝑛𝟓 𝑪𝒐𝒏𝒔𝒕𝒓𝒂𝒊𝒏𝒕
6n parameters for n moving links
J.Nassour 28
![Page 29: Forward Kinematics - TU Chemnitz · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/29.jpg)
Generalized Coordinates
A set of independent configuration parameters
𝟔 𝒑𝒂𝒓𝒂𝒎𝒆𝒕𝒆𝒓𝒔/𝒍𝒊𝒏𝒌 𝟑 𝒑𝒐𝒔𝒊𝒕𝒊𝒐𝒏𝒔𝟑 𝒐𝒓𝒊𝒆𝒏𝒕𝒂𝒕𝒊𝒐𝒏𝒔
01.11.2016
𝐿𝑖𝑛𝑘 1
Base
𝐿𝑖𝑛𝑘 2
𝐿𝑖𝑛𝑘 𝑛𝟓 𝑪𝒐𝒏𝒔𝒕𝒓𝒂𝒊𝒏𝒕
6n parameters for n moving links5n constraints for n joints
J.Nassour 29
![Page 30: Forward Kinematics - TU Chemnitz · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/30.jpg)
Generalized Coordinates
A set of independent configuration parameters
𝟔 𝒑𝒂𝒓𝒂𝒎𝒆𝒕𝒆𝒓𝒔/𝒍𝒊𝒏𝒌 𝟑 𝒑𝒐𝒔𝒊𝒕𝒊𝒐𝒏𝒔𝟑 𝒐𝒓𝒊𝒆𝒏𝒕𝒂𝒕𝒊𝒐𝒏𝒔
01.11.2016
𝐿𝑖𝑛𝑘 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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/31.jpg)
Generalized Coordinates
01.11.2016
D.O.F: n joints + ?
J.Nassour 31
![Page 32: Forward Kinematics - TU Chemnitz · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/32.jpg)
Generalized Coordinates
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/33.jpg)
Generalized Coordinates
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/34.jpg)
Operational Coordinates
01.11.2016
𝒐𝟎 𝒙𝟎 𝒚𝟎 𝒛𝟎
𝒐𝒏+𝟏 𝒙𝒏+𝟏 𝒚𝒏+𝟏 𝒛𝒏+𝟏
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/35.jpg)
01.11.2016
Operational Coordinates
Base
𝒙𝒚
𝒙
𝜶
𝒚
𝜶
Is also called Operational Space
J.Nassour 35
![Page 36: Forward Kinematics - TU Chemnitz · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/36.jpg)
01.11.2016
Joint Coordinates
Base
𝜽1
𝜽2𝜽3
𝜽1
𝜽2
𝜽3
Is also called Joint Space
J.Nassour 36
![Page 37: Forward Kinematics - TU Chemnitz · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/37.jpg)
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/38.jpg)
Redundancy
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/39.jpg)
Redundancy
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/40.jpg)
Redundancy
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/41.jpg)
Redundancy
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/42.jpg)
Redundancy
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/43.jpg)
Kinematic Arrangements
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/44.jpg)
Kinematic Arrangements
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/45.jpg)
Kinematic Arrangements
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/46.jpg)
Kinematic Arrangements
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/47.jpg)
Kinematic Arrangements
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/48.jpg)
Joint And Link Labelling
01.11.2016 J.Nassour 48
![Page 49: Forward Kinematics - TU Chemnitz · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/49.jpg)
Joint And Link Labelling
01.11.2016
𝒐𝟎𝒙𝟎 𝒚𝟎 𝒛𝟎Link 0 (fixed)Base frame
J.Nassour 49
![Page 50: Forward Kinematics - TU Chemnitz · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/50.jpg)
Joint And Link Labelling
01.11.2016
𝒐𝟎𝒙𝟎 𝒚𝟎 𝒛𝟎Link 0 (fixed)
Joint 1
Link 1
Joint variable 𝜽1
Base frame
J.Nassour 50
![Page 51: Forward Kinematics - TU Chemnitz · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/51.jpg)
Joint And Link Labelling
01.11.2016
𝒐𝟎𝒙𝟎 𝒚𝟎 𝒛𝟎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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/52.jpg)
Joint And Link Labelling
01.11.2016
𝒐𝟎𝒙𝟎 𝒚𝟎 𝒛𝟎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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/53.jpg)
Joint And Link Labelling
01.11.2016
𝒐𝟎𝒙𝟎 𝒚𝟎 𝒛𝟎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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/54.jpg)
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/55.jpg)
01.11.2016
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 · Forward Kinematics Determine the position and orientation of the ... The workspace of SCARA robot arm is of cylindrical shape. Workspace J.Nassour](https://reader031.fdocuments.in/reader031/viewer/2022012320/5b14ea9e7f8b9a7d068ca1fc/html5/thumbnails/56.jpg)
01.11.2016
Transformation Matrix
𝑻𝒋𝒊 =
𝑨𝒊+𝟏𝑨𝒊+𝟐…𝑨𝒋−𝟏 𝑨𝒋
𝑰
(𝑻𝒊𝒋)−𝟏
𝑖𝑓 𝒊 < 𝒋𝑖𝑓 𝒊 = 𝒋𝑖𝑓 𝒊 > 𝒋
if 𝒊 < 𝒋 then
𝑻𝒋𝒊 = 𝑨𝒊+𝟏𝑨𝒊+𝟐…𝑨𝒋−𝟏 𝑨𝒋 =
𝑹𝒋𝒊 𝒐𝒋
𝒊
𝟎 𝟏
The orientation part: 𝑹𝒋𝒊 = 𝑹𝒊+𝟏
𝒊 …𝑹 𝒋𝒋−𝟏
The translation part: 𝒐𝒋𝒊 = 𝒐𝒋−𝟏
𝒊+𝑹𝒋−𝟏𝒊 𝒐 𝒋
𝒋−𝟏
J.Nassour 56