436-459 Advanced Control and Automation Motion Control Lectures traditional CNC control architecture modelling of components dynamic response of axes effects on contouring performance control strategies to improve performance Case study Two-axis profiling machine Laboratory assignment design and implement controller on X-Y table subject to compliance, backlash and nonlinear friction L1:1
Elements of a servo-controlled axis L1: Source: DYNAMIC SERVO ACTUATORS www.danahermotion.com
L1:3 Mechanical elements Bearing Table Bearing Ballscrew Nut Gearbox or Belt Drive Guideway Motor References: Source: Position Measurement on Machine Tools by Jan Braasch http://www.heidenhain.com/techart.html Weck, Manfred. Handbook of machine tools, Volume 3, Automation and Controls. Wiley, 1984. [Eng Library: 61.90 WECK] HMT Limited. Mechatronics and Machine Tools. McGraw Hill, 1999. [Eng Library: 61 MECH]
Conventional CNC control architecture Source: "SERCOS interface" presentation by Rigobert Kynast (http://www.sercos.de/down_uesicht.htm) L1:4
Modern CNC control architecture L1:5
CNC issues axis position commands via high-speed bus L1:6
In some tracking systems contouring error is critical... Profiling machines laser plasma water-jet Non-circular machining High speed milling Pictures courtesy Farley LaserLab http://www.farleylaserlab.co.uk/home.php L1:7
5 4 3 1 0-1 - -3-4 -5 0 0.1 0. 0.3 0.4 0.5 Time (s) Contouring error Example: laser profiling cut 10 mm circle in 0.5 s trapezoidal velocity profiles V max = 5 m/min (83 mm/s) A max = 1.4 m/s 5 4 3 1 0-1 - -3-4 -5-10 -8-6 -4-0 X position (mm) 0.5 0.45 0.4 0.35 0.3 0.5 0. 0.15 0.1 0.05 0-10 -8-6 -4-0 X position (mm) L1:8 Y position (mm) Time (s) Y position (mm)
Contouring limitations bandwidth lag in axis response mismatch between axes nonlinearities actuator saturation, Coulomb friction vibrational modes L1:9 5 4 3 1 0-1 - -3-4 -5-10 -8-6 -4-0 X position (mm) Y position (mm)
In low-feedrate machines disturbance rejection could be more important Grinding machine - tool cutter grinder low speed smooth operation need shiny surface finish L1:10
Ripple torque and friction L1:11 Torque disturbance caused by motor cogging or electrical poles 500 400 300 00 100 0-100 PGX contour error: scale=0000, 3.8um/-.5um Soft Y (mm) -00-300 -400-500 -500-400 -300-00 -100 0 100 00 300 400 500 Soft X (mm) Friction effects at axis reversals
Modelling of two-axis contouring machine Conventional architecture Electromechanical dynamics Current, velocity and position control loops Simple model for axis position dynamics Captures effects of tuneable parameters in CNC Allows analytical derivation of contouring performance Case study of profiling machine Linearised, continuous-time model in MATLAB Nonlinear, hybrid model in Simulink L1:1
Mechanical modelling x = Pθ L /π L1:13 Mechanical elements of rigid servo axis drive Only 1 DoF so refer all inertias, friction and forces to motor shaft Kinetic energy is θ M J Effective total inertia Referred inertias T = J θ + J θ + Mx 1 1 1 M M L L 1 1 1 J θ M M J N P θ L M M N θ M ( ) ( ) = + + π P = J + J N + M N θ = J θ π 1 1 M L M M
x = Pθ L /π Rate of energy dissipation is F = B θ θ + B θ θ + B x x ( ) ( ) ( ) M M M L L L S = B + BN + B N θ = Bθ π P M L S M M Rate of working of external forces is P W = τ θ F x = τ F N θ π M M L M L M L1:14
L1:15 x = Pθ L /π Mechanical elements of rigid servo axis drive θm τ Μ JM rigid connection Motor Load τ L θ Μ = θ L /N J eff B M B eff Dynamically equivalent model, referred to motor speed
x = PNθ M /π + δ L1:16 Nθ M k L θm Mechanical elements of compliant servo axis drive τ Μ τ L JM k, c compliant connection J eff B M Motor Load π θ L = x PN B eff PN k = kl π Dynamically equivalent model, referred to motor speed
Mechanical dynamics (rigid model) τ M τ L J θ M B θ = ω M M J ω = τ τ Bω M M L M Θ = M Ω = M Ω s M T T Js + B M L T M Ω M Θ M Θ L X T L + 1 Js + B 1 s N P π L1:17
e a Electrical model for DC PM servo motor + i a R a L a e b + τ m θ m, ω m Equation set: B KVL for armature circuit: di a e a = R a i a + L a + e b dt Back-emf: e b = K b ω m J τ l Motor torque characteristic: τ m = K ii a E a + 1 I a T M Ls a + Ra K i E b = K b Ω m L1:18
Electromechanical model of motor and load L1:19 E a + 1 I a E b Ls a + Ra ( ) ( ) KI T = Js + B Ω i a L M E K I = L s+ R I a b a a a a K i K b T M Ω M Θ M X T L + 1 Js + B Ls + R K T I = ( Js + B )( L s + R ) + K K a a i L Ω M Kb Js+ B Ea a a a i b 1 PN s π Js + B K i ΩM T L Kb Las R a I = a E + a Transfer function E a Ω M Ω M K = i E JL s + JR + BL s+ BR + K K ( ) a a a a a i b
Transfer function E a Ω M Ω M K = i E JL s + JR + BL s+ BR + K K ( ) a a a a a i b L1:0 Often the armature inductance L a is negligible Ω M K = M Ea TMs+ 1 1 B KK = + T J JR 1 1 = + T T i b M a mechanical time constant m em K T M M electromechanical time constant = = K i BR + K K JR a BR + K K a i b a i b Motor gain (rad/sv) Motor time constant (s)
Example product specs for brushed permanent magnet DC servo motor L1:1
Case study: Two-axis profiling machine x-axis DC servo motor drives belt sprocket after speed reduction through a belt drive y beam x drive tube drive side (rack on rail; pinion driven through spur gears by y-axis DC servo motor) torch box (attached to thin stainless steel belt) idle side (roller on flat track) L1: