Académique Documents
Professionnel Documents
Culture Documents
1
Topics
2
Motion Control Theory
Closed Loop
System
3
Definitions
Accuracy
This term defines the ability of the controlled
axes to position an object in a spatial domain.
(how close you can come to the bulls-eye).
Another definition is the ability to reach a
predetermined point in space.
Resolution
Resolution is defined as resolving by the
breaking into parts.
The action of a rotary or linear feedback device
used for control purposes.
Repeatability
The ability to exactly replicate or reproduce a
motion profile as a continuous operation.
This term defines the ability of the controlled
axes to position the controlled object after
several moves
6
Definitions
Position Error
The dynamic difference between the position commanded by the controller
and the actual position of the object being moved.
Position Loop
The controller algorithm correcting the difference between the controller
commanded position and the feedback from the controlled axes used to
determine actual position
Speed or Velocity Loop
This loop is typically located in a drive. The function of the loop is to output
the motor torque required to maintain the speed/velocity commanded to the
drive amplifier.
Torque (current) Loop
The loop in the drive amplifier that is responsible for controlling the torque
producing current by comparing the motor actual shaft position (incremental
shaft position is integrated within the controller to determine the shaft
speed/velocity) to the actual shaft position.
7
When is Motion Control Required?
8
Example Closed Loop Control System
Reducer Load
Table Encoder
Motor
Power Ballscrew
AC/DC Position
Velocity Servo Loop Controller
Loop Amp
0 to 10V DC
10
What is a Servo?
A Servo is a control system which, through the use of feedback or internal control,
has the capability for accurate and repeatable control of one or more of the following
dynamic parameters
Position
Velocity
Torque
A Servo Axis is a principal direction along which motion occurs. The machine
hardware (mechanics) that make up that movement.
ROTARY LINEAR
Load
Motor
Ballscrew
Gearbox Ballnut
Pulleys
Motor
11
Components of a Motion Control System
Software
Servo Axis
Mechanical
Motion Drive/ Actuator/
Linkages
Controller Amplifier Motor And Load
Feedback
Transducer
12
Motion Control Theory
Servo
Motors
13
DC Motor Limitations
Rotor
windings
Air gap
Magnet
Commutator
Case
14
Servo Motors - Theory
Permanent Windings
Magnets
15
Servo Motors - Theory
Heat generated in
windings is directly
conducted to motor
case.
Winding is electronically
commutated.
16
Servo Motors - Theory
Magnet material
on rotor is lighter
than copper wire
windings.
17
Performance Limitations
12
10
4
Rotor
2 Magnets
12 10 8 6 4 2
De-magnetizing force - H (Kilo Oersteds)
19
Rare Earth vs. Ferrite Motors
20
Rare Earth vs. Ferrite Motors
Rare Earth Advantages:
Excellent magnetic properties (up to 30 MGOe).
Lower rotor inertia.
Smaller motor sizes for a given torque
Effective where high response speed, quick acceleration, high
efficiency and small size are required.
Rare Earth Disadvantages:
Magnetic material is expensive.
Samarium Cobalt and Neodymium material has a limited supply
(only available in a few areas of the world).
The system inertia must also be low (within at least 6 to 1 of motor
inertia). BEWARE! BEWARE! Inertia mismatch means stability
and control problems. System sizing is very critical. (High
resoultion feedback can help expand the range)
21
Rare Earth vs. Ferrite Motors
22
Motion Control Theory
Servo Drives
23
Servo Drives - Theory
200 Volts
Transistor is pulsed
on and off - low
Power from power dissipation.
DC Bus
Motor 20 Volts
10 Amps
24
Servo Drives - Theory
Period Period
Positive
Zero
Negative
Negative
25
Servo Drives - Theory
75% 25%
Positive
Positive
Zero
Negative
Negative
26
Servo Drives - Theory
Positive
Zero
Negative
Negative
27
Servo Drives - Theory
+
Comparator
+
PWM Output
Saw Tooth
Carrier
28
Servo Drives - Theory
Motor
Current
29
What makes a Servo Drive Unique?
30
Servo Drives - Theory
Trapezoidal
Sinusoidal
31
Servo Drives - Theory
There are two common methods of servo drive commutation:
Trapezoidal
Sinsoidal
Trapezoidal and Sinusoidal refer to the shape of the voltage
waveforms that the amplifier generates...
Trapezoidal
Sinusoidal
32
Servo Drives - Theory
Trapezoidal Commutation-
Requires only hall effect
feedback of rotor position
Sinusoidal Commutation
Requires encoder or
resolver feedback of rotor
position
33
Servo Drives - Theory
Torque
10-15%
Trapezoidal commutation
- Torque ripple
- Only hall effect feedback
required
Torque
Sinusoidal commutation
- Minimal torque ripple
- Encoder or resolver
feedback required
34
Motion Control Theory
Mechanical
Gearing
35
Definitions
Backlash
The relative movement between interacting mechanical
parts resulting from looseness.
Preload:
The process of forcing interacting mechanical parts
together to eliminate backlash.
Angular measurement:
60 Arc-minutes = 1 degree of rotation
3600 Arc-seconds = 1 degree of rotation Motion
Dictionary
36
Backlash
Backlash in
tooth profiles
37
Gearing
Types
Gearbox, Belt and Pulley, Gear Mechanism
Why?
Torque Increaser (Ratio), Tout = Tin x Z
Speed Reducer (Ratio), nout = nin x Z
Inertia Reducer (Ratio2) , jref = jload / Z2
38
Gearing Advantages
39
Application Considerations
40
Gearing Drawbacks
41
Speed Reduction
42
Torque Multiplication
43
Torque Multiplication
44
Inertia Matching
45
Typical Gearing Technologies
46
Spur/Helical Gear Technology
47
Planetary Gear Technology
Low Backlash
Very High Stiffness
Smooth Output Torque
90-95% Efficient Per Pass
Input Speeds < 3000 Rpm
Low Inertia
Limit to gear ratios without
staging planetary
48
Worm/Bevel Technology
Worm Gear Worm
Low Backlash
Very High Stiffness
40% Efficient, Lower At Start-Up
Moderate Input Speeds, Frictional
Heat
Low Inertia
Poor Back-Drive Capability
Bevel Gear
Spur gear technology but right angle Bevel
Right Angle Torque Transmission
Moderate Backlash
High Stiffness
96-98% Efficient
High Input Speed
Excellent Back Drive Capability
49
Belt Driven Technology
50
Gearhead Sizing
51
Motion Control Theory
Feedback
Devices
52
Feedback Devices
Position/ Motion
Velocity Control Servo
Control Drive Axis
Current/
Commutation
Loop
Feedback
Position/
Velocity 53
Feedback Devices
54
Feedback Devices
Encoder
Voltage
Encoder Time
Output
55
Incremental Encoder Output
Electrical Characteristics
TTL (5V) or CMOS (12v)
Single Ended
Complementary
Differential Line Driver
56
Incremental Encoder Output
(A+Noise)-(-A+Noise)=A+Noise+A-Noise=2A
57
Incremental Encoder Output
Channel A
Counterclockwise
Channel B Rotation
Marker
58
Incremental Encoder Output
Channel A
Channel B
1X Multiply
2X Multiply
4X Multiply
59
Resolvers
60
Resolvers
61
Resolvers
Sinusoidal
Input Sinusoidal
Output
Sinusoidal
Output
62
Resolvers
Rotor
63
Resolvers
Signal on Cosine
winding:
64
Resolvers
Signal on Cosine
winding:
65
Resolvers
Signal on Cosine
winding:
66
Resolvers
Signal on Cosine
winding:
67
Resolvers
Sine Output
Electronics looks
at portion of signal
indicated by green
lines.
Cosine Output
Rotor Signal
68
Resolvers
Sine value
Sine Output
Cosine value
Cosine Output
69
Resolvers
Sine value
Sine Output
Resolvers tell you where you are within
1 shaft rotation (Even immediately
after power up).
Cosine value
Cosine Output
70
Resolver - Interface
Resolver
Binary Angle
Output
71
Resolvers vs. Incremental Encoders
Resolvers Encoders
Lower device cost Lower interface cost
Absolute within one rev Variable resolutions
Higher noise immunity Easier to debug
Lower maintenance Easier to ratio together
Passive device
Smaller Package
Less Wires
Higher environmental specs.
72
Feedback Devices
Hall Effect
Device
Magnet
S N
73
Feedback Devices
Hall Effect
Devices Hall A
A
N C
Hall B
S
Hall C
Magnetic disk attached
to motor shaft.
74
Feedback Devices
A
N C
ABS
S Signal
ABS Signal
75
Feedback Devices
Channel A+
Channel A-
Channel B+
Channel B-
Channel Z+
Channel Z-
ABS
76
Feedback Trends
Devices:
Moving towards Motor Based Absolute Encoders
Encoders are approaching resolvers in robustness
Resolution:
Applications demanding 1M to 4M counts/motor rev in
precision applications (CNC, converting, etc.)
Motor based Absolute Encoders:
Want to eliminate homing on power up
Smart encoders that store motor parameters
77
Hi-Res Feedback
Hiperface
SRS, SRM Optical Encoder
ST & MT Absolute Versions Sin
F2
Vpps2
300m) _Data
78
Stegmann Hiperface
Process
Data 2 n+2
Channel Counter
Power
7 to 12 VDC Power
SRS/SRM Drive
79
Block Diagram of the Stegmann Multi-Turn Encoder
optical pick up
system vector Sin/Cos
controlled operational
LED-current amplifier
1 8 parameter
controller RS 485
driver
mechanical
gearbox with 1 8
customized power supply
magnetic (hall) Linear
pick up system integrated EEprom Regulator
for the multiturn circuit
1 8
function
1 8
80
Feedback Devices
*Typical values
81
Motion Control Theory
Motion
Controllers
82
Motion Controllers
83
Motion Controller Elements
Servos
Steppers
Hydraulics
VFDs
Mainframes
MIS Switches
SPC Indicators
Peer to Peer Readout
Actuators
Machine
Controller
Sensors
Gauges
Displays Meters
Keyboards Data Acquisition
Touch Screens Proportional Valves
84
Motion Controllers Provide
85
Motion Control
Determine
Position Error
86
Motion Control Profiles
87
When to use Triangular Velocity Profiles?
Triangular Profile
Accel to speed and decel back to
original speed or zero, rest and repeat Accel Decel
the process as needed.Ex. Pick & Place
0 1 2
88
When to use Trap / S-Curve Velocity Profiles?
Constant
Trapezoidal Profile Speed
Accel to constant speed, travel at
constant speed, and decel to zero.
Ex.Cut to Length Accel Decel
0 2
1 time (s)
S-Curve Profile
Accel to speed at a variable rate
(slower first, then faster, then slower),
travel constant speed, decel to zero at a
variable rate (slower first, then faster,
then slower).Ex. Bottling; Train ride at
Airports. 0 1 2 time (s)
89
Profiles
0 1 2 3 4 5 6 7 8 9 10 time (s)
Rest or Dwell
Cycle
90
Index Profile
Speed
Constant
Speed Batch
Dwell
Time
An index:
91
Move
D C
B C
A B
-5 -4 -3 -2 -1 0 1 2 3 4 5
Incremental Move
Go in the direction indicated (+/-) from where you are at the time the command is issued.
The # of units is specified.
A B = +2 2 units positive
B C = +1 1 unit positive
C D = -7 7 units negative
Absolute Move
A B=2 go to a position of 2
B C=3 go to a position of 3
C D = -4 go to a position of -4
92
Home
-5 -4 -3 -2 -1 0 1 2 3 4 5
Home Position
Home position is the base (zero) reference for all absolute moves.
It can be defined anywhere in the travel.
0 1 2 3 4 5 6 7 8 9 10 11
Home Position = all absolute moves are positive (+)
Load
Home
93
Overtravel
Overtravel = Going beyond the physical limits of the machine
-5 -4 -3 -2 -1 0 1 2 3 4 5
-5 +5
Overtravel limit switches shut down the drive before damage occurs from
crashing into machine limits.
Software overtravel limits are established inside of the hardware overtravel limits
(eg. +4.5, -4.5)
Move to 4 = Travel to 4 units = OK = Move
Move to 10 = Beyond SW OT = No Move
94
Resolution
C B A B C
96
Application Accuracy Requirements
97
Bandwidth
98
Motion Profiles
Things to Remember
100
Motion Control Theory
Torque
110
Torque
111
Torque
Torque:
Force
Torque Inertia
Produced
112
Torque
Torque - Example:
a = 50p rad/sec2 = 157.1 rad/sec2
Velocity
100p rad/sec
wmax
83p rad/sec
T = Jcyl x a = 146.6 in-lbs
67p rad/sec
Jcyl = .933 in-lbs-sec2
50p rad/sec
33p rad/sec
qa
17p rad/sec
0 rad/sec
0 1 2 3 4 Seconds Time
113
Torque
Vpeak
Desired
Load
Velocity
time
T1
Required
Motor T2
Torque T4
time
Tpeak
T3
t1 t2 t3 t4
Trms T 1 2 t1 + T 2 2 t2 + T 3 2 t 3 + T 4 2 t4
=
t1 + t2 + t3 + t4
115
Motion Control Theory
Inertia
116
Inertia
The product of the weight of an object (W) and the square of
the radius of gyration (K) (how the weight is distributed
around the axis of rotation).
Result = WK2 = Lb - Ft2
The magnitude of inertia is a function fourth power of its
radial dimension. Therefore a small diameter cylindrical rotor
inherently has a much lower inertia than a large diameter
motor.
A smaller Radius part has much less inertia than a larger
radius part.
Double radius - 24 = 16 times the inertia
Triple radius - 34 = 81 times the inertia
Servo System inertias are generally defined as IN-LB-SEC2
117
Inertia
Inertia - Examples:
118
Inertia
Inertia - Examples:
L
r
The inertia of a cylinder
rotating on the axis shown is:
119
Inertia Calculation using Diameter
Inertia - Examples:
L = 10 inches
r = 3 inches
Steel cylinder (r = .283 lbs/in3)
120
Inertia Calculation using Mass
Inertia - Examples:
r = 3 inches
Steel cylinder (W = 80 lbs)
121
Torque, Inertia, and Time
Time
Directly Inversely
Proportional Proportional
Inertia Directly
Torque
Proportional
Design
Considerations
123
When is Motion Control Required?
124
Selecting the Correct Motor
125
Relevant Application Data
126
Backlash Influences
135
Inertia Ratio and Backlash
137
Coupling and Resonance
138
Acceleration Requirements
140
Selecting The System
141