Servo Motor System

Modeling a Servo Motor System
MECHATRONICS ENGINEERING TECHNOLOGY
Definitions
Motor: A device that receives a continuous (Analog) signal and operates continuously in time. Digital Controller: Discretizes the amplitude of the signal and also operates at discrete time (sample data).
Continued
Position Sensor: Operates continuously in time but discretizes the amplitude. Power Amplifier: Power amplifier, which produces a continuous signal but operates at discrete times.
Elements to be modeled
Amplifier
Motor & Load
Position Sensor
Controller
Amplifier Motor Modeling
Current or Torque Mode Amplifier

In this type of operation mode, amplifier output current, I that is directly proportional to the input voltage V the proportionality factor Ka
1
Torque
where
Moment of Inertia of Solid Disc

mass m and radius r:
If J is total moment of inertia of load & motor, Tf is opposing friction,

Continued.
Where is acceleration,
Where
4
Combining equations 1 through 5
6
Position Sensor Modeling
Position Sensor Modeling

Motor position is indicated by position sensor as signal c. Kf proportionality factor, Kf equals the number of units of feedback per one radian of rotation. Encoder provides the position, suppose an incremental encoder generates N pulses per revolution, that the encoder generates output.
Continued
Channels A & B produces 1000 pulses for each encoder rotation. As two signals are shifted by one quarter of a cycle, the controller can divide each encoder cycle into four quadrant counts resulting in an effective resolution of 4N counts per revolution or turn. Since each revolution is 2 radians, the resulting encoder gain is
Model for Incremental Encoder:

7
Thus, 1000 pulse per rev encoder has an equivalent gain of 636 counts/ revolution.
Another common type of position sensor is the one of binary representation. Total number of positions per revolution is the model for this sensor is:
8
For example- For Absolute encoder or resolver with 16-Bit binary position signal has a gain of:
Modeling a Controller
Modeling a Controller
The desired position signal is R(t) or simply R actual position is C. Thus position error E:
This position error is used to generate the output signal that drives the motor.
Continued
The proportional term xp , Error, input Gain of the proportional part of the controller
Continued
The derivative term xd ,
Gain of derivative controller
Error, input
The integral term xi ,
Gain of the Integral Error, input controller Sum of all three outputs,
The Transfer function F(s), relating the output x to position error E is,
Examples
Example- Digital to Analog converter resolution, 8-16 bit. DAC having output voltage range -10 V to +10 V: Solution Output- -10 V to +10 V Gain of DAC K, equal to the number of volts it produces per unit of x input signal.
DAC Resolution in n bits, the DAC Gain equals: A 12-Bit DAC has K=0.0048 V/unit
Encoder Gain
Kf
4N
A Servo Motor System

xp
P DAC R AMPLIFIER MOTOR
E C
xd
sD
K V
Ka I
Kt/Js
1/s
xi
POSITION SENSOR
Kf
System with Voltage Amplifier

There are amplifier that are designed to produce a proportional output, N, rather than current, I. In this case, the amplifier is modeled as a voltage gain Kv U = Kv V When the voltage U is applied to the motor, it produces a current, I, which depends on the motor velocity angular velocity . The circuit equation of the motor is U = rI + sLI + Ke
16 17
Note
Motor Voltage includes three terms that represents three physical effects: rI, represents the voltage across the resistance, r. sLI, represents the voltage across the inductance, L. Ke , represents the emf indices by the motor that is function of , angular velocity.
The dynamic equation 3 can be represented in terms of as follows: J + Tf = Tg Since from equation 4 = (1s ) therefore =s Js + Tf = Tg Thus we can that dynamic behavior of the motor depends in the operation mode of the amplifier as evidence from the models.
18
Combining equation 2 and equation 18 and neglecting Tf, friction factor Js = Tg Js = Kt I I = (1/Kt) (Js)--Combining equation 17 and equation 19 U = 1/Kt (s2 JL + sJr + KeKt)--19 20
Now factoring M(s) = /U = Kt (s2JL + SJr + KeKt) Or, M(s) = 1/(Ke(sTm + 1) (sTe + 1))
21
22
Where, Tm = Jr / (Ke Kt) and Te = L/r
23
BLOCK DIAGRAM
R
E F x K V Kv U M(s) 1/s
Kf
The overall transfer function representing the combined effect of the motor and the amplifier is derived by combining the equation 5, 16 and 22 which is as follows: = (1s) --U = Kv V--M(s) = 1/(Ke(sTm + 1) (sTe + 1))--5 16 22
/V = Kv / Kes ((sTm + 1) (sTe + 1))-----
24
EXAMPLE 1
Amplifier: Operating in the current node with the current gain Ka of 0.6 amp per volt. Motor- load: Total amount of inertia, J = 2x10-4 kg.m2 and torque constant Kt = 0.12 Nm/A. Position Sensor: The position sensor is an incremental encoder with 1000 lines per revolution producing a resolution of 4000 counts/revolution. Motion Controller: The motion controller has a 14-bit DAC, and the filter parameter are P=20 and D=0.2.
MATHEMATICAL MODEL
/V = Ka Kt / Js2 = (0.6 A/V) (0.12 Nm/A) / (2x10-4 kg.m2) s2 = 360/s2 The incremental position sensor, according to equation 7 is modeled as: Kf = 4N/2 636 counts/radian The gain of the DAC, K, is given by the equation 14 as: K = 20/214 = 0.00122 Volts/Count Motion controller sensor is given by the equation 10 and 12 X/E = P + sD = 20+0.2s
Complete Mathematical Model

CONTROLLER DAC Motor
0.2s+20
x
0.00122
V
360/s
Controller output after PID Operation
ENCODER
Kf
EXAMPLE 2
Parameter Kt = 0.1 Nm/A J = 10-4 Kg.m2 Ka = 0.5 A/V Kf = 636 Counts/radian K = 0.00488 volts/count P = 20 (proportional constant) D = 0.1 (Derivative constant) Definition Motor Torque Constant Moment of Inertia Amplifier Gain Encoder Gain DAC Gain
Solution
Transfer Function of the Controller F(s) = 20+0.1s
CONTROLLER DAC AMPLIFIER Motor E
R C
F(s)=0.1s+20
x
K=0.00488
V
Ka=0.5
1000/s2
Controller output after PID Operation
ENCODER
Kf=636
Open-loop Transfer Function L(s)

L(s) = (/V ) (Kf) (X/E) (K) = (Ka Kt / Js2) (Kf) (P + sD) (K) = (1000/s2) (636) (0.00488) (0.1s +20) L(s) = (3103.68/ss) (0.1s+20) L(s) = (310.368s + 62073.6)/s2

Servo Motor System

Uploaded by

Copyright:

Available Formats

Servo Motor System

Uploaded by

Document Information

Original Description:

Copyright

Available Formats

Share this document

Share or Embed Document

Sharing Options

Did you find this document useful?

Is this content inappropriate?

Copyright:

Available Formats

Servo Motor System

Uploaded by

Copyright:

Available Formats

Modeling a Servo Motor System

MECHATRONICS ENGINEERING TECHNOLOGY

MECHATRONICS ENGINEERING TECHNOLOGY

MECHATRONICS ENGINEERING TECHNOLOGY

Motor & Load

Amplifier Motor Modeling

MECHATRONICS ENGINEERING TECHNOLOGY

Current or Torque Mode Amplifier

Moment of Inertia of Solid Disc

If J is total moment of inertia of load & motor, Tf is opposing friction,

MECHATRONICS ENGINEERING TECHNOLOGY

Combining equations 1 through 5

Position Sensor Modeling

MECHATRONICS ENGINEERING TECHNOLOGY

Position Sensor Modeling

MECHATRONICS ENGINEERING TECHNOLOGY

Model for Incremental Encoder:

MECHATRONICS ENGINEERING TECHNOLOGY

MECHATRONICS ENGINEERING TECHNOLOGY

MECHATRONICS ENGINEERING TECHNOLOGY

MECHATRONICS ENGINEERING TECHNOLOGY

MECHATRONICS ENGINEERING TECHNOLOGY

Gain of derivative controller

MECHATRONICS ENGINEERING TECHNOLOGY

The integral term xi ,

MECHATRONICS ENGINEERING TECHNOLOGY

MECHATRONICS ENGINEERING TECHNOLOGY

MECHATRONICS ENGINEERING TECHNOLOGY

MECHATRONICS ENGINEERING TECHNOLOGY

A Servo Motor System

System with Voltage Amplifier

MECHATRONICS ENGINEERING TECHNOLOGY

MECHATRONICS ENGINEERING TECHNOLOGY

MECHATRONICS ENGINEERING TECHNOLOGY

Where, Tm = Jr / (Ke Kt) and Te = L/r

MECHATRONICS ENGINEERING TECHNOLOGY

/V = Kv / Kes ((sTm + 1) (sTe + 1))-----

MECHATRONICS ENGINEERING TECHNOLOGY

Complete Mathematical Model

Controller output after PID Operation

MECHATRONICS ENGINEERING TECHNOLOGY

Controller output after PID Operation

MECHATRONICS ENGINEERING TECHNOLOGY

Open-loop Transfer Function L(s)

MECHATRONICS ENGINEERING TECHNOLOGY

You might also like