74
1/31 Kinematics Kinematics analyzes the geometry of a manipulator, robot or machine motion. The essential concept is a position. Statics deals with the forces and moments which are aplied on the mechanism at rest. The essential concept is a stiffness. Dynamics analyzes the forces and moments which result from motion and acceleration of a mechanism and a load. The terms and laws studied can be applied to robot-industrial manipulator as well as to any other machine with moving components. We will refer here to robot and will use some terms used in robotics (like end effector) but any machine could and shall be studied in similar way when position, stiffness or dynamics of the system is important.

Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

  • Upload
    others

  • View
    6

  • Download
    0

Embed Size (px)

Citation preview

Page 1: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

1/31Kinematics

Kinematics analyzes the geometry of a manipulator, robot ormachine motion. The essential concept is a position.

Statics deals with the forces and moments which are aplied on themechanism at rest. The essential concept is a stiffness.

Dynamics analyzes the forces and moments which result frommotion and acceleration of a mechanism and a load.

The terms and laws studied can be applied to robot-industrialmanipulator as well as to any other machine with movingcomponents. We will refer here to robot and will use some terms usedin robotics (like end effector) but any machine could and shall bestudied in similar way when position, stiffness or dynamics of thesystem is important.

Page 2: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

2/31

Kinematics – Terminology

J5 axisJ4 axis

Fore armElbow block

J3 axis

Upper arm

J2 axis

Base

J1 axis

Shoulder

J6 axis

Link is the rigid part of the robot body (e.g.forearm).

Joint is a part of the robot body whichallows controlled or free relative motionof two links (connection element).

End effector is the link of the manipulatorwhich is used to hold the tools (gripper,spray gun, welding gun...).

Base is the link of the manipulator which isusually connected to the ground and isdirectly connected to the world coordi-nate system.

Kinematic pair is a pair of links which rela-tive motion is bounded by the joint con-necting them (e.g. base and shoulderconnected by J1 axis).

Page 3: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

3/31

Kinematics – Terminology II

Kinematic chain is a set of links connected by joints. Kinematic chain can berepresented by a graph. The vertices represent links and edges represent joints.

Mechanism is a kinematic chain when one of its links is fixed to the ground.

Open kinematic chain Mixed kinematic chain Parallel manipulatorsis the chain which can be de-scribed by acyclic graph. contains in its graph a loop. consist of equivalent loops.

Page 4: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

3/31

Kinematics – Degrees of Freedom

Degrees of freedom (less formal definition) is a number ofindependent parameters needed to specify the position of themechanism completely. Examples:

Rigid body in a 2D space e.g. plane has 3 DOF.

Rigid body in a 3D space has 6 DOF.

A point in a plane has 2 DOF.

A point in a 3D space has 3 DOF.

Page 5: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

4/31

Kinematics – Degrees of Freedom

The DOF is important notion not only in robotics. Few more definitions are related to it:

Ambient space - the space robot/mechanism lives in, usually E2 (the plane - planarmanipulator) or E3 (space). It is Euclidean space.

Operational space.

is the subspace of the ambient space occupied by any of therobot part during any of possible robot motions. The operatio-nal (3D, physical) space shall be guarded by fence, doors orinvisible bariers to prevent injuries of both robot and humans.

Work envelope (working space).

is the subspace of the ambient space wherethe robot can reach by the end effector. Thecuts through this space are usually drawn inthe technical specifications by manufactu-rers. The work envelope has actually littleuse in the practice, it can just provide basicnotion where the robot can work.

Page 6: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

5/31

Kinematics – Degrees of Freedom

We usually need to study the position of the end effector or the tool fixed to it. Letus assume the end effector or tool is a rigid body.

The rigid body position in the 3D ambient space can be described by sixparameters. 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 allpossible 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 positionswhich can be reached by end effector (tool). All required end effector positionsshall of course lie in the working space, so the feasibility of the particular robotuse (its reach) shall be studied in this space.

The joint space a space of all possible??????????????????

joints space trajectories

The DOF is a dimension of the subspace which contains ??????????????

Page 7: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

6/31

Types of kinematic pairs

Symbol Name has/removes DOF

Spherical 3 / 3

Revolute 1 / 5

Prismatic 1 / 5

Cylindrical 2 / 4

Flat 3 / 3

Page 8: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

7/31

Typical structure of manipulators

Cartezian Cylindrical Spherical

Page 9: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

8/31

Typical structure of manipulators II

Angular SCARA

Animations taken from Masud Salimian’s web page

Page 10: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

9/31

Body in the coordinate system

Page 11: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

10/31

Body in the coordinate system

Point in 3D - described by three coordinates.

Rigid body in 3D - described by 6 coordinates:

� 3 coordinates of reference point x0 =æçççççççè

x0y0z0

ö÷÷÷÷÷÷÷ø

� orientation could be described e.g. by:

ê coordinates of vectors attached to the body (n, t,b),

ê Euler angles (Φ, Θ,Ψ),

ê rotational matrix R.

Page 12: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

11/31

Definition of Euler angles

Page 13: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

12/31

Rotation Matrix Resulting from Euler Anglesæçççççççç

è

Cos(Φ) Cos(Ψ) - Cos(Θ) Sin(Φ) Sin(Ψ) -Cos(Θ) Cos(Ψ) Sin(Φ) - Cos(Φ) Sin(Ψ) Sin(Φ) Sin(Θ)Cos(Ψ) Sin(Φ) + Cos(Φ) Cos(Θ) Sin(Ψ) Cos(Φ) Cos(Θ) Cos(Ψ) - Sin(Φ) Sin(Ψ) -Cos(Φ) Sin(Θ)

Sin(Θ) Sin(Ψ) Cos(Ψ) Sin(Θ) Cos(Θ)

ö÷÷÷÷÷÷÷÷

ø

Page 14: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

13/31Coordinate transformation

Page 15: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

14/31Consecutive coordinate transformations

Page 16: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

15/31

Open kinematic chain

Page 17: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

16/31

The Denavit-Hartenberg notation

Page 18: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

17/31

Adjacent coordinate frames in DH

Page 19: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

18/31

Position of end effector in base coordinate system

Page 20: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

19/31Base and end effector coordinate frames in DH

Page 21: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

20/31

5-R-1-P manipulator

Page 22: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

21/31Inverse kinematics

Page 23: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

22/31

Structure of 5-R-1-P manipulator

Page 24: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

23/31

Multiple configurations

Page 25: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

24/31PUMA

Page 26: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

25/31

Working space

Working spaceis a space of all points, where robot can place a held object or a tool.

Page 27: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

26/31Mixed kinematic chain

Page 28: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

27/31Mixed kinematic chain II

Page 29: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

28/31

Hexapod, prototype

Page 30: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

29/31

Hexapod, model

Page 31: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

30/31

Hexapod

Page 32: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

31/31

Hexapod

Page 33: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,

J5 axisJ4 axis

Fore armElbow block

J3 axis

Upper arm

J2 axis

Base

J1 axis

Shoulder

J6 axis

Page 34: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 35: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 36: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 37: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 38: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 39: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 40: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 41: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 42: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 43: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 44: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 45: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 46: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 47: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 48: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 49: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 50: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 51: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 52: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 53: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 54: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 55: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 56: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 57: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 58: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 59: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 60: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 61: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 62: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 63: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 64: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 65: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 66: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 67: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 68: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 69: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 70: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 71: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 72: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 73: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,
Page 74: Kinematics - Center For Machine Perception (Cmp)cmp.felk.cvut.cz/~smutny/teaching/robotics/lectures/kinematika.pdf1/31 Kinematics Kinematics analyzes the geometry of a manipulator,