Escolar Documentos
Profissional Documentos
Cultura Documentos
1
2
Kinematics analyzes the geometry of a manipulator, robot or 3
machine motion. The essential concept is a position. 4
Statics deals with the forces and moments which are aplied on 5
the mechanism at rest. The essential concept is a stiffness. 6
7
Dynamics analyzes the forces and moments which result from
motion and acceleration of a mechanism and a load. 8
9
The terms and laws studied can be applied to robot-industrial 10
manipulator as well as to any other machine with moving 11
components. We will refer here to robot and will use some terms 12
used in robotics (like end effector) but any machine could and 13
shall be studied in similar way when position, stiffness or dynamics 14
of the system is important. 15
16
17
18
19
20
21
Joint can be either controlled or freely moving. For con- system can change its position. Freely moving joint changes
trolled joint there is an actuator mounted in it and control its status according position of other joints.
1
Degrees of freedom (less formal definition) is a number of
2
independent parameters needed to specify the position of the
mechanism completely. 3
4
Examples: 5
6
A point in a plane has 2 DOF.
7
A point in a 3D space has 3 DOF. 8
9
Rigid body in a 2D space e.g. plane has 3 DOF. 10
11
Rigid body in a 3D space has 6 DOF. 12
13
14
15
16
17
18
19
20
21
2 Robot arm
R52
is the subspace of the ambient space occupied by any of the robot
2
6
R20
part during any of possible robot motions. R25
8
96
R6
Work envelope (working space) 85 315
170°
85
170°
.
Flange downward 308 238
limit line(dotted line)
P
Restriction on wide angle
R280
in the rear section Note2)
R280
in the front section Note5) in the rear section Note3)
87
R2
is the subspace of the am-
Restriction on wide angle
100
in the rear section Note1)
961
280
R33
135°
92°
1
594
R173
421
bient space where the ro-
350
294
R611
R331
179
17
Areas as restricted by Note1) and Note3)
°
within the operating range
76°
Restriction on wide angle
437 258
The operational (3D, physical) space shall be guarded by the technical specifications by manufacturers. The work enve-
fence, doors or invisible bariers to prevent injuries of both lope has actually little use in the practice, it can just provide
robot and humans. basic notion where the robot can work.
The cuts through the work envelope are usually drawn in
96
R6
Work envelope - example
2 Robot arm
170°
170° 6/21
85 315 85
Flange downward 308 238
limit line(dotted line) 170° P-point path: Reverse range
170° (alternate long and short dash line)
P
Restriction on wide angle P-point path: Entire range
R280
in the rear section Note2) (solid line)
0
R28
in the front section Note5) in the rear section Note3)
87
R2
Restriction on wide angle
100
R3
°
R5
31
92°
135
26
02
R2
594
R173
421
350
294
R611
R331
179
17
96
76°
R6
Restriction on wide angle
in the front section Note4)
444
437 258 474
P
Restriction on wide angle
R280
in the rear section Note2)
0
R28
in the front section Note5) in the rear section Note3)
87
R2
Restriction on wide angle
100
R3
°
31
92°
135
594
R173
421
350
294
R611
R331
179
17
We usually need to study the position of the end effector or the tool fixed to it. Let us
assume the end effector or tool is a rigid body.
The rigid body position in the 3D ambient space can be described by six parameters.
The semantics and values depend on the chosen parametrization, e.g. position of
the reference point on it (3 parameters) and 3 angles.
The “position” space is the 6D (3D for planar case) space representing all possible
positions of rigid body in 3D (2D) ambient space.
The end effector position can be studied in this 6D space position space.
The working space is a subspace of the position space containing positions which can
be reached by end effector (tool). All required end effector positions shall of course
lie in the working space, so the feasibility of the particular robot use (its reach)
shall be studied in this space.
1
Symbol Name has (f )/constraints (c) DOF
2
3
4
Spherical 3/3
5
6
7
Revolute 1/5
8
9
10
Prismatic 1/5
11
12
13
Cylindrical 2/4
14
15
Flat 3/3 16
17
18
19
20
21
Revolute joint is preferred in machinery as it can be easily We will study mainly robots with revolute and prismatic
and cheply manufactured, it has low friction, good rigidity. joints.
1
The number of degrees of freedom for mechanism:
2
ci number of constraints imposed by joint i, 3
fi number of DOF permitted by joint i, 4
5
n number of links in the mechanism (mechanism has one link fixed), 6
j number of joints in the mechanism (all shall be binary), 7
8
λ number of DOF of the space in which the mechanism lives,
9
F number of DOF of the whole mechanism. 10
11
j
12
X
F = λ(n − j − 1) + fi, 13
i=1 14
15
alternatively 16
j
X 17
F = λ(n − 1) − ci.
i=1
18
19
20
21
As a homework think about telescopic radio antena with 5 Does it hold equality in Grübler (Kutzbach) criterion? Where
cylinders. How many degrees of freedom has a final cylinder? is the singularity?
j
X
F = λ(n − j − 1) + fi,
i=1
alternatively
j
X
F = λ(n − 1) − ci.
i=1
Consider a transom mechanism on the figure. It models a This gives the correct result of 1 DOF of the mechanism.
window opened by sliding handle. The system could be viewed Spatial case (considering colinearity of D and E):
as planar or spatial. The number of degrees removed by the
joint will be denoted by planar/spatial numbers. The number F = 6(4 − 1) − (5 + 5 + 5 + 5) = −2
of links n = 4. The links are: Again unexpected result, but where is the mistake this time?
1 – window Think about it before reading the solution.
The problem is that correct function of transom mecha-
2 – connecting bar
nism assumes parallelity of A, B, and C joint axes. We should
3 – sliding handle model (and manufacture) them as having more freedom.
Case D, E being cylindrical and colinear, B spherical:
4 – window frame
They are connected by joints: F = 6(4 − 1) − (5 + 3 + 5 + 4) = 1
A – window hinge , revolute, removing DOF 2/5, Case B, C being spherical:
B – window – bar hinge , revolute, 2/5, F = 6(4 − 1) − (5 + 3 + 3 + 5) = 2
C – bar – slider joint , revolute, 2/5,
This means the link bar 2 could freely rotate around axis
D – 1st handle holder , prismatic, 2/5, passing through B and C.
Case A cylindrical, B spherical:
E – 2nd handle holder , prismatic, 2/5.
Let us insert the data into Gruebler formula: F = 6(4 − 1) − (4 + 3 + 5 + 5) = 1
Planar case: F = 3(4 − 1) − (2 + 2 + 2 + 2 + 2) = −1 This
Another practical solution is to make B and C as well as D
number is apparently wrong. Is it? Actually it is not, as the
and E slightly flexible, so minor nonparallelity of joints arran-
formula does not consider the colinearity of E and D joint
gement could be absorbed. It is cheap, but the mechanism is
which shall model just one prismatic joint.
not nicely sliding. Another, rather expensive, solution is to
The corrected planar case:
make individual parts adjustable, so during the instalation,
F = 3(4 − 1) − (2 + 2 + 2 + 2) = 1 the best position is found and fixed.
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
The body in the space has 6 DOF. The robot shall have Serial manipulator with 6 DOF consisting of prismatic
at least 6 DOF to allow (even in limited space) any position and revolute joints shall have at least three DOF with re-
and orientation of the body. The general manipulators have 6 volute joints, allowing arbitrary orientation of the manipula-
DOF satisfying this condition, more degrees of freedom me- ted body/accesory. Could you explain why manipulator with
ans more expensive both in HW and in control algorithms 6 prismatic joints cannot orient the body arbitrarily? Typi-
and lower stifness as well. cally three first joints (counting from the base), determine the
The joints which shall be measured and controlled are shape and properties of working envelope. This gives rise to
mostly prismatic or revolute as the joints with more degrees the classification of the robot structure according the type of
of freedom are difficult to build. On the other hand the joint the joints. The list presented is neither exhausting all mathe-
which need not be measured and controlled can easily be sphe- matical combinations nor all structures used in real life. The
rical or cylindrical, as this does not present technical problem. letters denote the order of the joints, e.g. RPP is revolute-
Serial manipulator shall of course have all joints measured prismatic-prismatic, that is cylindrical robot.
and controlled (Why??).
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
Animations taken from Masud Salimian’s web page 18
19
20
21
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
Systems with more degrees of freedom are used mainly for 5 DOF are enough for positioning of the rotationally sy-
two reasons: mmetrical welding head. Welds are often hidden in con-
• Increasing the volume of work envelope. Robot moun- fined places where all solutions of inverse kinematics
ted (usually hanged) on one or two gantry axes could are colliding with the product. One or two additional
operate much larger space. rotation axes positioning the product are often used to
allow one or more robots mounted on the floor to access
• Getting access to confined areas. Robot with 6 DOF whole welding trajectory.
could position rigid body or tool anywhere in the space.
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21