Professional Documents
Culture Documents
ME3015 - Industrial Robot - Nguyen, Quoc Chi - C2
ME3015 - Industrial Robot - Nguyen, Quoc Chi - C2
Robot Anatomy
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-1
Industrial Robot, Lecture 3-Robot Anatomy
Outline
Robot anatomy is concerned with the physical
construction and characteristics of the body, arm,
and wrist, which are components of the robot
manipulator:
- Degrees of freedom
- Drive systems
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-2
Industrial Robot, Lecture 3-Robot Anatomy
Structures of Robot
• Manipulator consists of joints and links
– Joints provide relative motion
– Links are rigid members between joints
– Various joint types: linear and rotary
– Each joint provides a “degree-of-
freedom”
– Most robots possess five or six
degrees-of-freedom
• Robot manipulator consists of two
sections:
– Body-and-arm – for positioning of
objects in the robot's work volume
– Wrist assembly – for orientation of
objects
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-3
Industrial Robot, Lecture 3-Robot Anatomy
Degrees of freedom
Degree Of Freedom (DOF): are the set of independent displacements
and/or rotations that specify completely the displaced or deformed
position and orientation of the body or system.
In Robot:
- Point location in space specified by three coordinates.
- Object location in space specified by location of a selected point on it
and orientation of the object.
Robotic kinematics
depends on the use of
right handed
Cartesian frames of
reference
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-4
Industrial Robot, Lecture 3-Robot Anatomy
Links
A link is a solid mechanical structure which connects two joints. The main purpose
of a link is to maintain a fixed relationship between the joints at its ends. The last
link of a manipulator has only one joint, located at the proximal end (the end closest
to the base) of the link. At the distal end of this link (the end furthest away from the
base) instead of a joint, there is usually a place to attach a gripper: a tool plate.
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-5
Industrial Robot, Lecture 3-Robot Anatomy
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-6
Industrial Robot, Lecture 3-Robot Anatomy
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-7
Industrial Robot, Lecture 3-Robot Anatomy
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-8
Industrial Robot, Lecture 3-Robot Anatomy
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-9
Industrial Robot, Lecture 3-Robot Anatomy
Spherical Joint: ??? constraints
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-10
Industrial Robot, Lecture 3-Robot Anatomy
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-11
Industrial Robot, Lecture 3-Robot Anatomy
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-12
Industrial Robot, Lecture 3-Robot Anatomy
Open-chain
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-13
Industrial Robot, Lecture 3-Robot Anatomy
Degrees of freedom
The number of degrees of freedom for mechanism:
We have:
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-14
Industrial Robot, Lecture 3-Robot Anatomy
Degree of freedom
4
F = 3(4 − 4 − 1) + ∑1 = 1
1
2
F = 3(3 − 2 − 1) + ∑1 = 2
1
9
F = 3(8 − 9 − 1) + ∑1 = 3
1
0-15
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-15
Industrial Robot, Lecture 3-Robot Anatomy
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-16
Industrial Robot, Lecture 3-Robot Anatomy
Quiz: 20 mins
Calculate the degree of freedom of five bar and
parallelogram mechanism
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-17
Industrial Robot, Lecture 3-Robot Anatomy
Quiz: 20 mins
Calculate the degree of freedom of five bar and
parallelogram mechanism
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-18
Industrial Robot, Lecture 3-Robot Anatomy
Determine the DOF of the two mechanisms
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-19
Industrial Robot, Lecture 3-Robot Anatomy
Degree of freedom
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-20
Industrial Robot, Lecture 3-Robot Anatomy
Drive systems
- The drive system determines the speed of the arm movement,
the strength of the robot, dynamic performance, and, to some
extent, the kinds of application.
- Robot actuators quality: have enough power to acc/dec the
links, carry the loads, light, economical, accurate, responsive,
reliable and easy to maintain.
• Electric drive • Hydraulic drive • Pneumatic drive
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-21
Industrial Robot, Lecture 3-Robot Anatomy
Poly-Phase
Brushless DC
(3 phase)
Linear
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-22
Industrial Robot, Lecture 3-Robot Anatomy
Hydraulic system vs. Pneumatic system
Hydraulic system
Pneumatic system
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-23
Industrial Robot, Lecture 3-Robot Anatomy
Electric actuators
DC motor Brushless DC motor
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-24
Industrial Robot, Lecture 3-Robot Anatomy
DC motor
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-25
Industrial Robot, Lecture 3-Robot Anatomy
DC motor
F: force on the conductor (in Newton)
The magnitude of the I: current through the conductor (in amperes)
force on the wire: B: magnetic flux density (in gauss)
L: length of the wire (in meters)
θ: angle between the magnetic field and current
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-26
Industrial Robot, Lecture 3-Robot Anatomy
Brushless DC motor
Brushless DC motors (BLDC) operate without brushes by taking
advantage of modern electronic switching techniques.
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-27
Industrial Robot, Lecture 3-Robot Anatomy
Brushless DC motor
A schematic of a generalized three-phase BLDC
AC motor
AC motors work by rotating the stator field. It makes use of the natural
alternating nature of the AC wave to turn the field coils on and off
sequentially.
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-29
Industrial Robot, Lecture 3-Robot Anatomy
AC motor
As the stator field rotates past an
individual bar, the field strength in
the bar rises and falls. This changing Diagram of
“squirrel cage”
magnetic field induces a voltage in
the bar, and the voltage causes a
current to flow. The current flows
through the bar, through the end
rings, and back through other bars.
This current causes the bar to have a
magnetic field, and it is this field,
interacting with the rotating stator
field, that produces the mechanical
Assembled
torque. rotor
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-30
Industrial Robot, Lecture 3-Robot Anatomy
AC motor
The rotor is always going slower than the rotating field, and this difference is
referred to as slip. Slip is frequently given as a percentage (usually less than
10%) of the stator speed.
Synchronous equation:
Ss: synchronous (stator) speed (in rpm)
Sr: rotor speed (rpm)
f: frequency of the AC line
P: number of field poles per phase
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-31
Industrial Robot, Lecture 3-Robot Anatomy
Stepper motor
A stepper motor is a unique type of DC motor
that rotates in fixed steps of a certain number
of degrees. Step size can range from 0.9 to 90°.
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-32
Industrial Robot, Lecture 3-Robot Anatomy
Stepper motor
Excitation modes for PM stepper motors
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-33
Industrial Robot, Lecture 3-Robot Anatomy
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-35
Industrial Robot, Lecture 3-Robot Anatomy
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-36
Industrial Robot, Lecture 3-Robot Anatomy
Servo system
What is a servo motor? - A command signal which is issued from the user's
interface panel comes into the servo's "positioning controller". The positioning
controller is the device which stores information about various jobs or tasks. It
has been programmed to activate the motor/load, i.e. change speed/position.
load
position,
speed
mech. energy
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-38
Industrial Robot, Lecture 3-Robot Anatomy
What to control?
Current control = torque control
- Maintaining current (torque) constant
- Mostly included in controller (but not always accessible)
- For fast motor reaction
- No special feedback device needed
Speed control
- Maintaining speed constant
- "speed = 0" does not mean "position is held"
Position control
- Moving from position to position, stop at and maintain a
position
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-39
Industrial Robot, Lecture 3-Robot Anatomy
incremental
IxR DC tacho encoder Hall sensor resolver
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-40
Industrial Robot, Lecture 3-Robot Anatomy
Analog encoder speed control loop
• Speed control loop with encoder feedback
- Amplification (gain) depends on parameters PID
- Applies also to Hall Sensor feedback with EC motors (6 IMP)
• Current control loop
- Subordinate control loop, enhances system dynamics
- Power amplifier (MOSFET)
speed power
amplifier (PID) amplifier
set value R current current
Σ E Σ motor
speed + command +
- -
current-
C
feedback
speed
feedback encoder
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-41
Industrial Robot, Lecture 3-Robot Anatomy
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-42
Industrial Robot, Lecture 3-Robot Anatomy
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-44
Industrial Robot, Lecture 3-Robot Anatomy
Resolution = 1 / 2N
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-45
Industrial Robot, Lecture 3-Robot Anatomy
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-46
Industrial Robot, Lecture 3-Robot Anatomy
Incremental optical encoder
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-47
Industrial Robot, Lecture 3-Robot Anatomy
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-50
Industrial Robot, Lecture 3-Robot Anatomy
Reduction gears
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-51
Industrial Robot, Lecture 3-Robot Anatomy
Planetary gears
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-52
Industrial Robot, Lecture 3-Robot Anatomy
Harmonic drive
A Harmonic Drive (also known as
"Strain Wave Gearing") is a special
type of mechanical gear system that
has no backlash, compactness and
light weight, high gear ratios (a ratio of
100:1 is possible in the same space in
which planetary gears typically only
produce a 10:1 ratio).
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-53
Industrial Robot, Lecture 3-Robot Anatomy
Harmonic drive
• Wave Generator
The wave generator is a
component having small ball
bearings built into the outer
circumference of the elliptical
cam. The wave generator is
usually attached to the input
shaft.
• Flexspline
The flexspline is a thin cup-shaped metal rim component with external
teeth. The bottom of the flexspline (cup bottom) is called the
diaphragm. The diaphragm is usually attached to the output shaft.
• Circular Spline
The circular spline is a rigid steel ring with internal teeth.
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-54
Industrial Robot, Lecture 3-Robot Anatomy
Harmonic drive
The circular spline (ncs) has two teeth more than the flexspline
(nfs) and is usually fixed to a casing.
nfs − ncs
Ratio =
nfs
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-55
Industrial Robot, Lecture 3-Robot Anatomy
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-56
Industrial Robot, Lecture 3-Robot Anatomy
Ball-screw drive
A ball screw is a mechanical linear actuator that translates rotational
motion to linear motion with little friction. The ball assembly acts as
the nut while the threaded shaft is the screw. Ball screws tend to be
rather bulky, due to the need to have a mechanism to re-circulate the
balls.
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-57
Industrial Robot, Lecture 3-Robot Anatomy
Timing-belt drive
Synchronous / timing
belts having grooves
which mate with teeth
on the pulleys.
These belts are used for power transfer and for synchronized
drives to ensure that the driven pulley is always rotating at a
fixed speed ratio to the driving pulley.
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-58
Industrial Robot, Lecture 3-Robot Anatomy
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-59
Industrial Robot, Lecture 3-Robot Anatomy
Comparison between drive systems
Hydraulic Electric Pneumatic
- May leak. Not fit for clean - Low stiffness - Noisy systems
room applications - Need reduction gears, - Require air pressure,
- Require pump, reservoir, increased backlash, cost, filter, etc.
motor, hoses, etc. weight, etc. - Difficult to control their
- Can be expensive and - Motor needs braking linear position.
noisy. Requires device when not powered. - Deform under load
maintenance Otherwise, the arm will fall constantly
- Viscosity of oil changes - Very low stiffness.
with temperature Inaccurate response
- Very susceptible to dirt - Lowest power to weight
and other foreign material ratio
in oil
- Low compliance
- High torque, high
pressure, large inertia on
the actuator
© 2016 Quoc Chi Nguyen, Head of Control & Automation Laboratory, nqchi@hcmut.edu.vn 3-60