ROBOT KINEMATICS

Václav Hlaváč

Czech Technical University in Prague

Faculty of Electrical Engineering, Department of Cybernetics
Center for Machine Perception
http://cmp.felk.cvut.cz/˜hlavac, [email protected]

Outline of the talk:

1. Kinematics, what is?
2. Open, closed kinematic mechanisms.
3. Sequence of joint transformations (matrix multiplications).
4. Direct vs. inverse kinematic task.
 Initial comments
2/45

We will refer here to a robot as a proxy for a mechanical device, its position,


stiffness or dynamics is of interest.

The terms and laws studied here can be applied to an industrial manipulator,


any other robot, and any other mechanism with moving components.
 Mechanics and its parts
3/45

Kinematics analyzes the geometry of a motion analytically, e.g. of a robot,

with respect to a fixed reference co-ordinate system,


without regard to the forces or moments that cause the motion.



Essential concepts are position and orientation.



Statics deals with forces and moments which are applied on the mechanism
which is not moving. The essential concept are the stiffness and the stress.
Dynamics analyzes forces and moments which result from motion and
acceleration of a mechanism and a load.
 Need of kinematics in robotics
4/45

Knowing the kinematical description of a robot is a prerequisite of its control



and programming.
Kinematics provides knowledge of both robot’s spatial arrangement and a


means of reference to the environment.

 Kinematics → dynamics, control
5/45

Kinematics is only the first step towards robot control !

Cartesian Space Joint Space Actuator Space

z
y
x
 Kinematics – Terminology
6/45

Link is the rigid part of the robot



body (e.g. forearm).

Joint is a part of the robot body


which allows controlled or free relative

motion of two links (connection
element).
End effector is the link of the


manipulator which is used to hold the

tools (gripper, spray gun, welding gun
. . . ).
Base is the link of the manipulator


which is usually connected to the

ground and is directly connected to
the world coordinate system.
Kinematic pair is a pair of links which


relative motion is bounded by the

joint connecting them (e.g. base and
shoulder connected by J1 axis).
Open chain manipulator kinematics
7/45

Mechanics of a manipulator can be represented


as a kinematic chain of rigid bodies (links) con-
nected by revolute or prismatic joints.
Kinematics can be represented by an acyclic


graph (tree). Example: human hand.
 One end of the chain is constrained to a base,
while an end effector is mounted to the other
end of the chain.
The resulting motion is obtained by composition


of the elementary motions of each link with re-

spect to the previous one.
Open chain manipulators, examples
8/45
 Closed kinematic chain
9/45

Much more difficult. Can be represented by a (general, cyclic) graph.



Even analysis has to take into account statics, constraints from other links,


etc.
Synthesis of closed kinematic mechanisms is very difficult.


Main advantage = high stiffness.


Closed kinematic chain examples
10/45

Hybrid chain Parallel chain

 Kinematics vs. differential kinematics
11/45

in a special case of an open kinematic chain mechanism, e.g. a robotic

manipulator
Kinematics describes the analytical relationship between the joint positions


and the end-effector position and orientation.

Differential kinematics describes the analytical relationship between the joint


motion and the end-effector motion in terms of velocities.

 Degrees of Freedem, a free rigid object
12/45

Q: How many parameters (Degrees of Freedom, DoF) are needed to specify



a flying rigid body?

A: Six, three coordinates of the position x, y, z, and three rotation angles.
Example: Kinematics of the airplane allows it to move anywhere in the 3D


space.

+ Yaw (also heading)

+ Roll
+ Pitch
 Degrees of freedom, example, question
13/45

Q: How many degrees of freedom (DoF) has this manipulator?



A:

 Degrees of freedom, example, answer
14/45

Q: How many degrees of freedom (DoF) has this manipulator?



A: Six again. 2 base + 1 shoulder + 1 elbow + 2 wrist = 6.


 Kinematic joints, a quiz
15/45

Q: Joints examples: How many degrees of freedom they have?

Cardan joint 3D gimbal spherical

A:
 Kinematic joints, answers to the quiz
16/45

Q: How many degrees of freedom?

Cardan joint 3D gimbal spherical

A: 2 DOFs 3 DOFs 3 DOFs
singularities no singularities
Kinematic joints
17/45

Planar Spherical
3 DOF 3 DOF

Cylindrical Revolute
2 DOF 1 DOF

Prismatic Helical
1 DOF 1 DOF
Structure of manipulators – Cartesian – PPP
18/45

Cartesian

Gantry
Structure of manipulators – Cylindrical – RPP
19/45
Structure of manipulators – Spherical – RRP
20/45
Structure of manipulators – Angular – RRR
21/45

Called also: anthropomorphic

Structure of manipulators – SCARA – RRRP
22/45
 Structure of manipulators – Stewart platform
23/45

Parallel kinematics.


6 DoFs.


6 prismatic actuators, commonly



hydraulic jacks.
Called also 6-axes platform or


hexapod.
Designed by V. E. Gough in 1954


for tyre testing.

Published by D. Stewart in 1965.

 Stewart platform, applications
24/45

Large jacks FANUC Flight simulator

Hexamod
25/45
Real hexamod
26/45
 Direct vs. inverse kinematics
27/45

In an open chain kinematic manipulator robotics, there are two kinematic tasks:
1. Direct (also forward) kinematics
Given: joint relations (rotations, translations) for the robot arm.
Task: What is the orientation and position of the end effector?
2. Inverse kinematics
Given: the desired end effector position and orientation.
Task: What are the joint rotations and orientations to achieve this?

In a more general case of close kinematic chain mechanisms, a more general statement is needed:
1. Direct kinematics
Given: the geometric structure of the manipulator and the values of a number of joint
positions equal to the number of degrees of freedom of the mechanism.
Task: Find a relative position and orientation of any two designed joints.
2. Inverse kinematics
Given: a relative position and orientation of any two designed joints.
Task: Find values of all joints position and orientations.
Coordinate frames
28/45
Two basic types of joints
29/45

Revolute Prismatic
 Manipulator description
30/45

Revolute
joint
Prismatic
Link i joint

Base = 1 fixed link End effector

Links: n moving links, 1 fixed link (base).



Joints: revolute (1 DOF), prismatic (1 DOF).


 Configuration parameters
31/45
Configuration parameters are given by a set of positions describing the full


configuration of the system.

6 parameters
per link

x
y

Generalized coordinates – a set of independent configuration parameters.



Degrees of freedom – number of generalized coordinates.


 Generalized coordinates (1)
32/45

6 parameters
(3 positions, 3 orientations)

n unconstraint moving links ⇒ 6n parameters.

 Generalized coordinates (2)
33/45

5 constrains

5 constrains

n moving links ⇒ 6n parameters.



n 1 DOF joints ⇒ 5n constraints.



The system has 6n − 5n = n DOFs.


 End-effector configuration parameters
34/45

z On+1

O
x
y

O – Origin of the world coordinates at the manipulator base.



On+1 – Operational point, the representative point of the end-effector.



(x1, x2, . . . , xm) – A set of parameters, which specifies the end-effector



position and orientation with respect to coordinate system O.

 Operational (joints) coordinates
35/45

z On+1

O
x
y

(x1, x2, . . . , k) – A set of k, k ≤ m independent configuration parameters.



m0 – number of end-effector degrees of freedom.


Joint coordinates → joint space
36/45
Manipulator redundancy
37/45
 Two frames kinematic relationship
38/45

There is a kinematic relationship between two frames, basically a translation



and a rotation.
This relationship is represented by a 4 × 4 homogeneous transformation


matrix.
 Homogeneous transformation
39/45

r1 r2 r3 x

3x3 rotation matrix r4 r5 r6 y 3x1 translation

r7 r8 r9 z

1x3 perspective 0 0 0 1 global scale

Rotation matrix R is orthogonal ⇔ RTR = I ⇒ 3 independent entries, e.g.,

Euler angles.
Kinematic open chain
40/45
 Direct vs. inverse kinematics, a reminder
41/45

In an open chain kinematic manipulator robotics, there are two kinematic tasks:
1. Direct (also forward) kinematics
Given: joint relations (rotations, translations) for the robot arm.
Task: What is the orientation and position of the end effector?
2. Inverse kinematics
Given: the desired end effector position and orientation.
Task: What are the joint rotations and orientations to achieve this?
 Direct kinematics
42/45

One joint: xi = Axi−1.



Chain of joints: xn−1 = An−1 An−2 . . . A1 A0 x0.



Easy to compute (matrix multiplication).



Unique solution.

 Inverse kinematics
43/45

For an open chain kinematic mechanism (a robot), the inverse kinematic



problem is difficult to solve.

The robot controller must solve a set of non-linear simultaneous algebraic


equations.
Source of problems:


• Non-linear equations (sin, cos in rotation matrices).

• The existence of multiple solutions.
• The possible non-existence of a solution.
• Singularities.
 Inverse kinematics, simplifications
44/45

Divide and conquer strategy. Decouple the problem into independent



subproblems.
The spherical wrist. Positioning of the wrist + positioning within the wrist.


Design conventions, e.g. Denavit-Hartenberg systematic frame assignment.


 Methods solving the inverse kinematics task
45/45

1. Closed-form solutions. Relevant for industrial manipulators.

Algebraic methods.


Geometric methods.


2. Numerical methods.
Symbolic elimination methods: involve analytical manipulations to


eliminate variables from a system of nonlinear equations to reduce it to

a smaller set of equations.
Continuation methods: involve tracking a solution path from a start


system with known solutions to a target system.

Iterative methods: are in general based on Newton-Raphson metod


using 1st order approximation of the original algebraic equation. They

converge in a single solution (from several possible) based on the initial
guess.