Synergetic Control of the Unstable Two-Mass System

Similar documents
Synergetic Control for Electromechanical Systems

Synergetic Synthesis Of Dc-Dc Boost Converter Controllers: Theory And Experimental Analysis

Space flying vehicles orbital motion control system synthesis: power invariants

SWING UP A DOUBLE PENDULUM BY SIMPLE FEEDBACK CONTROL

ECEN 420 LINEAR CONTROL SYSTEMS. Lecture 6 Mathematical Representation of Physical Systems II 1/67

A Light Weight Rotary Double Pendulum: Maximizing the Domain of Attraction

Automatic Control II Computer exercise 3. LQG Design

Fuzzy modeling and control of rotary inverted pendulum system using LQR technique

Übersetzungshilfe / Translation aid (English) To be returned at the end of the exam!

Control Systems. Internal Stability - LTI systems. L. Lanari

FUZZY LOGIC CONTROL Vs. CONVENTIONAL PID CONTROL OF AN INVERTED PENDULUM ROBOT

Review: control, feedback, etc. Today s topic: state-space models of systems; linearization

CHAPTER 1. Introduction

Course of lab activities on control theory based on the Lego NXT

Math 266: Phase Plane Portrait

KINETIC ENERGY SHAPING IN THE INVERTED PENDULUM

Balancing of an Inverted Pendulum with a SCARA Robot

Stabilization of Motion of the Segway 1

Intermediate Process Control CHE576 Lecture Notes # 2

A plane autonomous system is a pair of simultaneous first-order differential equations,

Torques 1.0 Two torques We have written the swing equation where speed is in rad/sec as:

Chapter 13 Lecture. Essential University Physics Richard Wolfson 2 nd Edition. Oscillatory Motion Pearson Education, Inc.

EE 16B Midterm 2, March 21, Name: SID #: Discussion Section and TA: Lab Section and TA: Name of left neighbor: Name of right neighbor:

Linearization problem. The simplest example

Dynamic Modeling of Rotary Double Inverted Pendulum Using Classical Mechanics

In the presence of viscous damping, a more generalized form of the Lagrange s equation of motion can be written as

LMI Methods in Optimal and Robust Control

Disturbance Decoupling Problem

Matlab-Based Tools for Analysis and Control of Inverted Pendula Systems

available online at CONTROL OF THE DOUBLE INVERTED PENDULUM ON A CART USING THE NATURAL MOTION

Control. CSC752: Autonomous Robotic Systems. Ubbo Visser. March 9, Department of Computer Science University of Miami

Control Systems I. Lecture 2: Modeling. Suggested Readings: Åström & Murray Ch. 2-3, Guzzella Ch Emilio Frazzoli

Swing-Up Problem of an Inverted Pendulum Energy Space Approach

(Refer Slide Time: 00:01:30 min)

Disturbance Attenuation for a Class of Nonlinear Systems by Output Feedback

Stability of Nonlinear Systems An Introduction

28. Pendulum phase portrait Draw the phase portrait for the pendulum (supported by an inextensible rod)

Nonlinear Oscillators: Free Response

Control of Nonlinear Hysteresis Systems by Riemannian Geometric Approach

Partial-State-Feedback Controller Design for Takagi-Sugeno Fuzzy Systems Using Homotopy Method

SWINGING UP A PENDULUM BY ENERGY CONTROL

Modelling and Control of DWR 1.0 A Two Wheeled Mobile Robot

MEAM 510 Fall 2011 Bruce D. Kothmann

Linear and Nonlinear Oscillators (Lecture 2)

Interactions Between Two Non-Stationary Pendulums

Funnel control in mechatronics: An overview

MCE 366 System Dynamics, Spring Problem Set 2. Solutions to Set 2

ASTATISM IN NONLINEAR CONTROL SYSTEMS WITH APPLICATION TO ROBOTICS

ENERGY BASED CONTROL OF A CLASS OF UNDERACTUATED. Mark W. Spong. Coordinated Science Laboratory, University of Illinois, 1308 West Main Street,

Stabilization and Passivity-Based Control

Lecture 9 Nonlinear Control Design

Reverse Order Swing-up Control of Serial Double Inverted Pendulums

Reglerteknik, TNG028. Lecture 1. Anna Lombardi

Design and Comparison of Different Controllers to Stabilize a Rotary Inverted Pendulum

Laboratory Exercise 1 DC servo

Mechatronic System Case Study: Rotary Inverted Pendulum Dynamic System Investigation

EN Nonlinear Control and Planning in Robotics Lecture 10: Lyapunov Redesign and Robust Backstepping April 6, 2015

EECS C128/ ME C134 Final Wed. Dec. 15, am. Closed book. Two pages of formula sheets. No calculators.

Solving the Van Der Pol nonlinear differential equation using first order approximation perturbation method

Energy-based Swing-up of the Acrobot and Time-optimal Motion

Appendix W. Dynamic Models. W.2 4 Complex Mechanical Systems. Translational and Rotational Systems W.2.1

Control Systems I. Lecture 2: Modeling and Linearization. Suggested Readings: Åström & Murray Ch Jacopo Tani

IMECE NEW APPROACH OF TRACKING CONTROL FOR A CLASS OF NON-MINIMUM PHASE LINEAR SYSTEMS

MEAM 510 Fall 2012 Bruce D. Kothmann

School of Engineering Faculty of Built Environment, Engineering, Technology & Design

A Model-Free Control System Based on the Sliding Mode Control Method with Applications to Multi-Input-Multi-Output Systems

LMI based output-feedback controllers: γ-optimal versus linear quadratic.

Nonlinear Autonomous Systems of Differential

A Novel Integral-Based Event Triggering Control for Linear Time-Invariant Systems

State Regulator. Advanced Control. design of controllers using pole placement and LQ design rules

Comparison of LQR and PD controller for stabilizing Double Inverted Pendulum System

Nonlinear Tracking Control of Underactuated Surface Vessel

Modeling and Control Overview

Swinging-Up and Stabilization Control Based on Natural Frequency for Pendulum Systems

General procedure for formulation of robot dynamics STEP 1 STEP 3. Module 9 : Robot Dynamics & controls

Lecture 9 Nonlinear Control Design. Course Outline. Exact linearization: example [one-link robot] Exact Feedback Linearization

Closed-Loop Impulse Control of Oscillating Systems

Exam. 135 minutes, 15 minutes reading time

Chapter 15. Oscillatory Motion

Real-Time Implementation of a LQR-Based Controller for the Stabilization of a Double Inverted Pendulum

INTELLIGENT CONTROL OF DYNAMIC SYSTEMS USING TYPE-2 FUZZY LOGIC AND STABILITY ISSUES

8 Example 1: The van der Pol oscillator (Strogatz Chapter 7)

NMT EE 589 & UNM ME 482/582 ROBOT ENGINEERING. Dr. Stephen Bruder NMT EE 589 & UNM ME 482/582

Time Response of Systems

CONTROL OF ROBOT CAMERA SYSTEM WITH ACTUATOR S DYNAMICS TO TRACK MOVING OBJECT

SCHOOL OF ELECTRICAL, MECHANICAL AND MECHATRONIC SYSTEMS. Transient Stability LECTURE NOTES SPRING SEMESTER, 2008

CALIFORNIA INSTITUTE OF TECHNOLOGY Control and Dynamical Systems

Balancing of the skateboard with reflex delay

Forced Oscillations in a Linear System Problems

Constructive Invariant Manifolds to Stabilize Pendulum like systems Via Immersion and Invariance

Lab 6d: Self-Erecting Inverted Pendulum (SEIP)

FUZZY SWING-UP AND STABILIZATION OF REAL INVERTED PENDULUM USING SINGLE RULEBASE

Performance of Feedback Control Systems

Chaos suppression of uncertain gyros in a given finite time

S12 PHY321: Practice Final

Experimental investigation of micro-chaos

Assignments VIII and IX, PHYS 301 (Classical Mechanics) Spring 2014 Due 3/21/14 at start of class

Open Loop Tuning Rules

CDS 101/110a: Lecture 2.1 Dynamic Behavior

Linearize a non-linear system at an appropriately chosen point to derive an LTI system with A, B,C, D matrices

Transcription:

Synergetic Control of the Unstable Two-Mass System Alexander A. Kolesnikov Department of Automatic Control Systems Taganrog State University of Radio-Engineering Nekrasovsky str. 44, Taganrog GSP-17A, 34798, Russia Abstract The paper is devoted to a problem of synergetic regulators synthesis for nonlinear unstable two-mass system inverted pendulum. The different variants of synergetic regulators synthesis for this system are presented. Synthesized regulators are constructed on basis of nonlinear mathematical models. The synthesized regulators allow not only to solve the pendulum stabilization task at the top unstable position but also form the new modes of dynamic behavior such as auto-oscillations of the pendulum and the cart around the set position 1 Introduction More than 30 years in the world literature on control theory and systems there are discussions about the inverted pendulum IP) system control [1 5]. The thing is that the two-mass system inverted pendulum to a certain degree reflects various real systems from a biomechanical system of hand and body motion to the behavior of various manipulating robots and other pendulum systems. Due to its distinctive features this model has became a sort of test problem for control theory methods from classical linear methods based on PID regulators to the modern ones based on Fuzzy Neural Networks using a certain combination of a PID regulator with a fuzzy one [ 5]. It should be mentioned that most of the works consider linearized IP models. This essentially limits the possibilities of reaching the ultimate characteristics of the IP control systems. The task of controlling the IP described by the full nonlinear model is a complex one. Its solution will allow to reach ultimate recoverable pendulum degrees with an account of limitation on the cart s position and the value of the control force etc. In all the considered task belongs to the important problem of controlling the nonlinear oscillating objects of various nature. Here for solving this task the principles and the methods of synergetic control theory [6] are used and main research results are presented. Mathematical Model Let consider the IP shown at figure 1. The pendulum s axis is mounted on the cart that can move horizontally. The cart is driven by a drive that applies a force µt) at time t. This 1

Figure 1: Inverted pendulum on cart force is the control action for the system. Analyzing forces and motions we can describe the system dynamics by following nonlinear mathematical model: ẋ 1 t) = x 3 ; ẋ t) = x 4 ; ẋ 3 t) = u;.1) ẋ 4 t) = g L sin x 1 L cos x u, where x 1 = s cart s horizontal motion; x = ϕ pendulum s angle, x 3 = ṡt), x 4 = ϕt); m, L pendulum s mass and the distance from axis to the mass center, J moment of inertia; M cart s mass, L = J+mL pendulum s effective length; ml m L L µ u = L M + m) ml cos x ml D sx 3 ml g sin x ) + x L 4 sin x..) Nonlinear differential equations.1),.) describe the behavior of the system IP controlled cart. As we see form these equations, one and the same control ut) and therefore µt)) is applied to different channels separated by dynamic units. From our point of view this quality lead to many years of not very successful attempts of many specialists to solve the task of synthesis of effective control laws ensuring vertical pendulums position by means of applying force to the cart.

We had an idea to apply synergetic method of analytical design of aggregated regulators ADAR) [6] and to search for such a nonlinear transform that would allow to extend the allowed angle range to the ultimate values: π < x < π. We also wanted to take out the limitations on the cart s position. This allows to obtain an exhaustive solution of set control task. Let s proceed to consideration of such a transform of coordinates. 3 Nonlinear Transform of Coordinates Let s introduce the following macrovariable: ψ = x 1 π γ π dt 3.1) then we get and ψt) = ẋ 1 t) + ẋ t) γ cos x ψt) = ẍ 1 t) + π 3.) cos x ẍ t) + ẋ t) cos x tan x + γẋ t) cos x. 3.3) Substitute the derivatives ẍ 1 t) and ẍ t) into 3.3) from the initial equations i.e. ẍ 1 t) = u, 3.4) As a result we get or ψt) = u + cos x ẍ t) = g L sin x 1 L cos x u. 3.5) [ g L sin x 1 ] L cos x u + ẋ t) tan x + γẋ t) 3.6) cos x cos x ψt) = Bu + g L tan x + ẋ t) cos x tan x + γẋ t) cos x, 3.7) where B = 1 L. According to the ADAR method we form the functional equation ψt) + α 1 ψt) + α ψ = 0, α 1 > 0, α > 0. 3.8) Substituting ψt) 3.7) into 3.8) we get the control u = g B L tan x ẋ t) tan x γẋ t) F ẋ ) α 1 B cos x B cos x B cos x B ψt) α ψ. 3.9) B 3

4 Motion on the Manifolds According to the ADAR method, control u 3.9) moves the system 3.4), 3.5) to the manifolds ψ = 0 3.1) and ψt) = 0 3.) from the arbitrary initial conditions. Motion of the coordinate x on the manifolds ψ = ψt) = 0 is described by the equations 3.5), 3.9), i.e. ẍ ψ t) = g L sin x ψ + g BL ) sin x ψ + B L ẋ ψ tan x ψ + γ B L ẋψt). 4.1) To make the solutions of the equation 4.1) stable we ll assign B = λ < 0, then g BL ) = 1 + λ λl g, Accounting for 4.), equation 4.1) takes the following form: = 1 + λ B L λ, = λ + 1)L. 4.) ẍ ψ t) + a 1 sin x ψ + a ẋ ψ t) tan x ψ + a 3 ẋ ψ t) = 0, 4.3) where a 1 = g λl, a = λ + 1 λ, a 3 = γ λl. 4.4) The equation 4.3) with a 1 > 0, a > 0, a 3 > 0 is asymptotically stable with respect to x ψ = 0 in the range π < x ψ < π. Depending on the values of the coefficients a 1, a, a 3, the equation 4.3) can have various character of the transients. The most influence is caused by the coefficient γ. The equation 4.3) appeared because of introduction of the nonlinear transform 3.1), which allowed to ensure asymptotic stability of motion on the manifolds ψ = 0 and ψt) = 0 and, therefore, stability of the initial system with a control law 3.9). Indeed, according to 4.1) with a 1 > 0, a > 0, a 3 > 0 the angle x always approaches zero, which means stabilization of the pendulum at the top position. This phenomenon can be interpreted as an effect of generation of the internal stabilizing controls resulting from nonlinear transform of coordinates. It should be underlined that this quality of internal controls generation is a result of synergetic control theory laws. 5 Control Laws and Modeling Results Let s write the control law 3.9) using the notation 4.) in the following form: u = 1 + λ λ tan x g ẋ t) ) L + γ ẋ t) + α 1 cos x λ cos x λ ψt) + α ψ, 5.1) λ where: ψ = x 1 + 1 + λ)l ψt) = ẋ 1 t) + π dt. 5.) π ẋ t) γ. 5.3) π γ 1 + λ)l cos x 4

Figure : Pendulum s Subsystem Phase portrait Figure 3: Cart s Subsystem Phase portrait Now using the expressions.1) and.) basing on 5.1) 5.3) we find the control µx 1, x, x 3, x 4 ): µ = ml x 4 sin x + g sin x ) + D L s x 3 + 1 M + m ml ) cos x λ L [ ) L 1 + λ) x 1 + λ)l π 4 g tan x + α 1 x + x 4 γ cos x cos x ) + 5.4) + γx 4 + α x 1 + 1 + λ)l π cos x π γ )] dt. In 4.1) we should select such α i that ψt) has the desired character of changing. So during the aperiodic process: then α = 1 T 1 T ; ψt) = c 1 e t T 1 α 1 α = T 1 + T, 5.5) + c e t T, 5.6) which is ensured by the proper selection of T 1 and T. If the selection of α 1, α is different from 5.5) results in a damping oscillating transient. Figures and 3 present the modeling results for the control law 5.4) for the subsystems of the pendulum and the cart. Fig 4 presents transients for x 10 = 0, 5, x 0 = 0, 5. We can use the following control instead of 3.8) ψt) ξ1 βψ ) ψt) + ψ = 0. 5.7) 5

Figure 4: Transients Figure 5: Pendulum s Subsystem Phase portrait Figure 6: Cart s Subsystem Phase portrait The equation 5.7) is the Van-der-Paul Equation, that describe the auto-oscillations mode. The control law takes the following form: u = 1 + λ g + ẋt) ) L tan x + γ ẋ t) ξ1 βψ ) λ cos x λ cos x ψt) + ψ. 5.8) The phase portraits for the pendulum s and cart s subsystems are presented in Figures 5 and 6 for u 5.8). Modeling was performed with the following parameters: L = 0, 1, L = 0, 1, M = 1, m = 0, 1, g = 9, 81, D s = 100, γ = 1, λ = 1, β =, ξ = 0, 5. It should be mentioned that control laws µx) acquired as a result of application of the synergetic synthesis methods are actually the torques created by cart electric drives. According to the ADAR method, knowing µx 1,..., x 4 ) it is very easy to get the corresponding closed loop laws controlling the voltage on the drive s input. To do this, µx 1,..., x 4 ) should be presented as internal controls and then basing on the drive s model we should synthesize corresponding control laws for electric drive control. 6

6 Conclusion The performed research allowed to achieve the following scientific results: an absolutely new synergetic control method was developed. It is based on the proposed nonlinear transform of coordinates and uses a full nonlinear system s model. This allowed to obtain exhaustive solution of the control problem comparing to the known results. The two-mass system IP-cart is theoretically controllable in the maximal range π < x < π ) without any limitations on the cart s motion. The developed new synergetic control method has an important individual meaning. It allows to solve a wide range of control tasks for various oscillating mechanical systems that were unsolvable by the known methods of control theory; the developed methods of synergetic control allow not only to solve the pendulum stabilization task at the top unstable position but also form the new modes of dynamic behavior such as auto-oscillations of the pendulum and the cart around the set position. So application of the synergetic approach to the control task for the unstable nonlinear system IP-cart allowed to obtain exhaustive solution of the control task for a full nonlinear model. This indicates the outstanding capabilities of the synergetic approach to solution the complex control tasks arising in various classed of nonlinear objects. Acknowledgement: This work was supported by the US Office of Naval Research under Grant N00014 00 1 031. References [1] Cannon R.H.,Jr., Dynamics of Physical Systems. Mc.Graw-Hill, New York, 1967. [] Elgerol O.I., Control Systems Theory. Mc.Graw-Hill, New York, 1967. [3] Brusin V.A. Global Stabilization of the System Inverted Pendulum on a Cart Under the Influence of Unmeasured Disturbance // Izvesitya RAS. Technical Cybernetics, 1993, # 3. [4] Jang S., Araki M. Mathematical analysis of fuzzy control systems and on possibility of industrial applications //Trans. Soc. Instrum. and Contr. Eng., 1990, V.6, # 11. [5] Saito T., Togawa K. Controls of inverted pendulum: By the technique using the analog control elements //Res. Repts Nagaoka Technic. Coll., 1991, V.7, #. [6] Kolesnikov A.A. Synergetic Control Theory. Moscow, Energoatomizdat, 1994. 7