Inverted Pendulum control with pole assignment, LQR and multiple layers sliding mode control

Similar documents
Swing Up a Pendulum by Energy Control

Oscillations: Review (Chapter 12)

Applying Experienced Self-Tuning PID Controllers to Position Control of Slider Crank Mechanisms

Ufuk Demirci* and Feza Kerestecioglu**

Reducing Vibration and Providing Robustness with Multi-Input Shapers

Modular Control of a Rotary Inverted Pendulum System

Application of Neural Networks for Control of Inverted Pendulum

16.30/31 September 24, 2010 Prof. J. P. How and Prof. E. Frazzoli Due: October 15, 2010 T.A. B. Luders /31 Lab #1

Design of Sliding Mode Stabilizer for Wind Turbine Generator using Dynamic Compensation Observer Technique

Adaptive Controller Design for a Synchronous Generator with Unknown Perturbation in Mechanical Power

Nonlinear controller design for a magnetic levitation device

Neural Network Control of an Inverted Pendulum on a Cart

ACTIVE VIBRATION CONTROL FOR STRUCTURE HAVING NON- LINEAR BEHAVIOR UNDER EARTHQUAKE EXCITATION

Chapter 2: Introduction to Damping in Free and Forced Vibrations

MSEC MODELING OF DEGRADATION PROCESSES TO OBTAIN AN OPTIMAL SOLUTION FOR MAINTENANCE AND PERFORMANCE

Studying Large Scale System Using Decentralized Control

Internet-Based Teleoperation of Carts Considering Effects of Time Delay via Continuous Pole Placement

Applying Genetic Algorithms to Solve the Fuzzy Optimal Profit Problem

Physics 140 D100 Midterm Exam 2 Solutions 2017 Nov 10

Robustness Experiments for a Planar Hopping Control System

Impulsive Control of a Mechanical Oscillator with Friction

CHAPTER 19: Single-Loop IMC Control

Simple Harmonic Motion

Neural Dynamic Optimization for Control Systems Part III: Applications

Wall Juggling of one Ball by Robot Manipulator with Visual Servo

Modern Control Systems (ECEG-4601) Instructor: Andinet Negash. Chapter 1 Lecture 3: State Space, II

Decentralized Adaptive Control of Nonlinear Systems Using Radial Basis Neural Networks

Chapter 1: Basics of Vibrations for Simple Mechanical Systems

Smith Predictor Based-Sliding Mode Controller for Integrating Process with Elevated Deadtime

Resonance and Friction Compensations in a Micro Hard Drive

Tutorial Exercises: Incorporating constraints

Design Of Optimal Pid Controller Using Genetic Algorithm

Nonlinear Stabilization of a Spherical Particle Trapped in an Optical Tweezer

A Simulation Study for Practical Control of a Quadrotor

IAENG International Journal of Computer Science, 42:2, IJCS_42_2_06. Approximation Capabilities of Interpretable Fuzzy Inference Systems

ANALYSIS OF HALL-EFFECT THRUSTERS AND ION ENGINES FOR EARTH-TO-MOON TRANSFER

NAME NUMBER SEC. PHYCS 101 SUMMER 2001/2002 FINAL EXAME:24/8/2002. PART(I) 25% PART(II) 15% PART(III)/Lab 8% ( ) 2 Q2 Q3 Total 40%

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

In the session you will be divided into groups and perform four separate experiments:

THE NEW EXTREMAL CRITERION OF STABILITY

HYBRID ADAPTIVE FRICTION COMPENSATION OF INDIRECT DRIVE TRAINS

MASSACHUSETTS INSTITUTE OF TECHNOLOGY Department of Mechanical Engineering 2.010: Systems Modeling and Dynamics III. Final Examination Review Problems

TOPIC E: OSCILLATIONS SPRING 2018

Warning System of Dangerous Chemical Gas in Factory Based on Wireless Sensor Network

Self-Erecting Inverted Pendulum: Swing up and Stabilization Control

Simulation and Experimental Works of Quadcopter Model for Simple Maneuver

Stabilization fuzzy control of inverted pendulum systems

Department of Electronic and Optical Engineering, Ordnance Engineering College, Shijiazhuang, , China

BioTechnology. BioTechnology. An Indian Journal FULL PAPER KEYWORDS ABSTRACT

Friction Induced Hunting Limit Cycles: An Event Mapping Approach

Periodic Motion is everywhere

Definition of Work, The basics

Using a De-Convolution Window for Operating Modal Analysis

SEISMIC FRAGILITY ANALYSIS

Envelope frequency Response Function Analysis of Mechanical Structures with Uncertain Modal Damping Characteristics

Department of mechanics, Faculty of engineering Hamadan branch, Islamic azad university, Hamadan, Iran. Abstract

USEFUL HINTS FOR SOLVING PHYSICS OLYMPIAD PROBLEMS. By: Ian Blokland, Augustana Campus, University of Alberta

The Lagrangian Method vs. other methods (COMPARATIVE EXAMPLE)

DESIGN OF THE DIE PROFILE FOR THE INCREMENTAL RADIAL FORGING PROCESS *

Chapter 11: Vibration Isolation of the Source [Part I]

An Adaptive UKF Algorithm for the State and Parameter Estimations of a Mobile Robot

Simple Harmonic Motion

Lecture 4 Normal Modes

Chapter 11 Simple Harmonic Motion

3D acoustic wave modeling with a time-space domain dispersion-relation-based Finite-difference scheme

T m. Fapplied. Thur Oct 29. ω = 2πf f = (ω/2π) T = 1/f. k m. ω =

ANALYSIS OF LANDING TRAJECTORY USING BACKWARD PROPAGATION

MECHANISM DESIGN AND DYNAMIC FORMULATION FOR CART/SEESAW/PENDULUM SYSTEM

The dynamic game theory methods applied to ship control with minimum risk of collision

(6) B NN (x, k) = Tp 2 M 1

ROTATIONAL MOTION FROM TRANSLATIONAL MOTION

821. Study on analysis method for deepwater TTR coupled vibration of parameter vibration and vortex-induced vibration

System Design of Quadrotor

Particle dynamics Physics 1A, UNSW

Experimental Design For Model Discrimination And Precise Parameter Estimation In WDS Analysis

Simple and Compound Harmonic Motion

Mathematical Model and Algorithm for the Task Allocation Problem of Robots in the Smart Warehouse

Use of PSO in Parameter Estimation of Robot Dynamics; Part One: No Need for Parameterization

CALIFORNIA INSTITUTE OF TECHNOLOGY

System Modeling and Control of a Clutch Actuator System for Dual Clutch Transmissions

ME357 Problem Set The wheel is a thin homogeneous disk that rolls without slip. sin. The wall moves with a specified motion x t. sin..

A Gyroscope Control System for Unknown Proof Mass and Interface Circuit Errors

Design and Stability Analysis of Single-Input Fuzzy Logic Controller

3. In the figure below, the coefficient of friction between the center mass and the surface is

Role of Control-Structure Interaction in Protective System Design

Monitoring and system identification of suspension bridges: An alternative approach

Assignment 2. Tyler Shendruk October 8, Hamilton s Principle - Lagrangian and Hamiltonian dynamics.

Fast Montgomery-like Square Root Computation over GF(2 m ) for All Trinomials

Accuracy of the Scaling Law for Experimental Natural Frequencies of Rectangular Thin Plates

Unit 14 Harmonic Motion. Your Comments

Modeling & Analysis of the International Space Station

CONTROL SYSTEMS, ROBOTICS, AND AUTOMATION Vol. IX Uncertainty Models For Robustness Analysis - A. Garulli, A. Tesi and A. Vicino

Problem Set 14: Oscillations AP Physics C Supplementary Problems

Simple Schemes of Multi anchored Flexible Walls Dynamic Behavior

Energy and Momentum: The Ballistic Pendulum

Cooperative Load Transport Using Multiple Quadrotors

Elastic Force: A Force Balance: Elastic & Gravitational Force: Force Example: Determining Spring Constant. Some Other Forces

PHYS 1443 Section 003 Lecture #22

Course support: Control Engineering (TBKRT05E)

Analysis of ground vibration transmission in high precision equipment by Frequency Based Substructuring

Transcription:

J. Basic. Appl. Sci. Res., 3(1s)363-368, 013 013, TetRoad Publication ISSN 090-4304 Journal of Basic and Applied Scientific Research www.tetroad.co Inverted Pendulu control with pole assignent, LQR and ultiple layers sliding ode control Haed Ebrahii Mollabashi 1, Marziyeh Raabpoor, Soroush Rastegarpour 3 1,3 MSc student in Departent of Electrical Engineering, Islaic Azad University (IAU), South Tehran Branch, Tehran, Iran. MSc student in Departent of Electrical Engineering, Islaic Azad University (IAU), science and Research, Tehran, Iran. Received: June 10 013 Accepted: July 1 013 ABSTRACT Inverted pendulu syste is one of popular and iportant laboratory odels for teaching control syste engineering. This paper presents a ultiple layers sliding ode controller and pole assignent controller and LQR for inverted pendulu syste. In ultiple layers sliding ode control, firstly, the given syste is divided into several subsystes. Then, one subsyste is selected to construct the first layer sliding ode surface and it is used to construct the second layer sliding ode surface with the sliding ode surface of another subsyste. This process continues till all states of all subsystes are included. The controller is designed according to this ultiple layers structure. For optiization of sliding surfaces constants are used genetic algorith. KEYWORD: Pendulu, LQR, sliding ode I. INTRODUCTION The inverted pendulu syste is a standard proble in the area of control systes. They are often useful to deonstrate concepts in linear control such as the stabilization of unstable systes. The sliding ode controller is a powerful nonlinear controller, which has been developed and applied to feedback control systes for the last three decades [1]. For under actuated systes, designing a conventional sliding ode surface is not appropriate, because the paraeters of the sliding ode surface can't be obtained directly according to the Hurwitz condition. Many papers on the control of inverted pendulu(s) systes have been published. Nieann [1] designed a u controller for a double inverted pendulus syste. In [], Oatu presented two PID controllers for single and double inverted pendulus systes, whose paraeters were regulated by genetic algorith (GA) and neural network (NN), respectively. Yi [3] proposed a fuzzy controller for this class of under-actuated systes. The structure characteristic of a class of under actuated systes, such as inverted pendulu(s) systes, is that they can be divided into several subsystes. According to this structure characteristic of inverted pendulu(s) systes, Mon and Lin [5] presented a hierarchical sliding ode controller (HSMC) for a double inverted pendulus syste and a single inverted pendulu syste, respectively, whose paraeters were regulated by fuzzy logic. But both of the only guaranteed the second level sliding ode surface was stable. Ebrahii [4] give the stability analysis for under-actuated systes with ore subsystes. For optiization of response is used genetic algorith. (GA) iproved the coefficient of sliding ode surface. In this paper, three ethods are used for control of linear odel of Inverted Pendulu, pole assignent, LQR and ultiple layers sliding ode control II. MODELING A scheatic of the inverted pendulu is shown in Figure 1. Self-balancing robots heavy cranes lifting containers in shipyards rockets and issiles future transport systes like: Segway s and etpacks real eaples of inverted pendulu syste. For the analysis of syste dynaic equations, Newton s second law of otion was applied [7]. Fig. 1: inverted pendulu * Corresponding Author: Haed Ebrahii Mollabashi, MSc student in Departent of Electrical Engineering, Islaic Azad University (IAU), South Tehran Branch, Tehran, Iran. haed_ebrahii@aol.co 363

Mollabashi et al.,013 These equations are obtained by equating Horizontal Forces Cart, F M M F N b M F N l cos l cos ( M ) b l cos l sin F (1) And these equations are obtained by equating Forces acting Perpendicular to the Pendulu FN N p sin N cos g sin l cos ( I l ) gl sin l cos () I. M I. pl sin Nl cos I. p sin N cos l Nonlinear for of Inverted Pendulu syste can be depicted by: 1 f b u 1 1 3 4 f b u 1 4 is the cart position, 4 is the velocity of the cart, 3 (3) is the pendulu angle with respect to the vertical line; is the angle velocity of the pendulu with respect to the vertical line, and the epressions of f 1, f, b 1 and b are given in [1] We linearize the syste about the unstable equilibriu : ( ) I l g l l ( M ) b l F The linearization of the cart-pendulu syste around the upright position is: A Bu y C D 0 1 0 0 b ( I l ) gl 0 0 I ( M ) Ml I ( M ) Ml A 0 0 0 1 bl gl ( M ) 0 0 I ( M ) Ml I ( M ) Ml ( 4 ) B C 0 ( I l ) I ( M ) M l 0 l I ( M ) M l 1 0 0 0 0 0 1 0 (5 ) 364

J. Basic. Appl. Sci. Res., 3(1s)363-368, 013 D 0 0 III. MULTIPLE LAYERS SLIDING MODE CONTROL DESIGN Fro [4-5] we can design ultiple layers sliding ode control for inverted pendulu. For SIMO under actuated echanical systes, the atheatical odel can be translated into the following for: 1 f1 b1u (6) 3 4 4 f bu Where X [ 1,,... ] T the state variables and u is the input of the syste, f n n and b n are bounded noinal. As the Multiple layers sliding structure has been shown in Figure. First layer can be defined by [4-5] 1 1 1 Fig. : sliding ode surfaces s c c the equivalent law control obtain fro 1 0 c f1 c1 0 c1 1 c c1 c ( f1 b1 u ) u eq (1) (7) c b1 s The second layer defined as s c3 3 s1 and s3 c4 4 s so the total U eq is: u c. c f 1 1 1 e q ( i ) 1 c b u sw(i) is the switch control law for every layer sliding surface, u sw(i) can iproved the response tie.[4] The switch control law is defined as: 0 i 1 i u sw ( i ) sgn( s ) / den( i) i 1 1 ( 8 ) (9) Where is a positive constant, 1 d en ( i) c b ( c. b.sgn ( s )) (10) 1 1 c i and ɳ are constants which have the sae sign but this paraeters and other sliding surface can't be obtain according Hurwitz condition so for this reason and optiizations, using genetic algorith. U u u (11) s i eq i sw i 365

Mollabashi et al.,013 IV. The GA Optiization Genetic algoriths, introduced by Holland [6], are based on the idea of engendering new solutions fro parent solutions, eploying echaniss inspired by genetics. In the following tet the controller will be optiized by genetic algorith. The optiization paraeters are c i. The nuber of variables is 8. The fitness function is shown as forula. Evaluate the fitness value of each output. n T T ( R u qu) (1) i0 i i V. POLE ASSIGNMENT CONTROL DESIGN Pole placeent ethod is one of the classic control theories and has an advantage in syste control for desired perforance. Theoretically pole placeent is to set the desired pole location and to ove the pole location of the syste to that desired pole location to get the desired syste response. For using pole placeent control design assuptions are: 1- The syste is copletely state controllable - The state variables are easurable and are available for feedback. 3- Control input is unconstrained. The open loop poles are placed at 0, -0.0999, -7.0, and 7.1430 fro the iaginary ais. Now we want to ove these poles to -8, -6, -1, and -1 fro the ais. To ove to the desired pole location we have to fine feedback gains. K is fine feedback gain. VI. SIMULATION RESULTS M ass of the cart 1kg ass of the pendulu 1kg b friction of the cart 0.1N//sec l length of the pendulu 0.1 i inertia of the pendulu 0.006 kg. F force applied to the cart kg. / s g gravity 9.8 / s θ Vertical pendulu angle in degree 1 is cart position velocity of the cart, 3 Vertical pendulu angle and 4 angle velocity of the pendulu 0, 0, pi / 3, 0 Initial values are: 1 3 4 With GA, constant is found: c= [-0.3643-0.7448 3.9157 0.7355-0.4195 0.041 0.7938 5.1554] Fig. 3: Tie response of carts positions (ultiple layers sliding ode control). 366

J. Basic. Appl. Sci. Res., 3(1s)363-368, 013 Fig. 4: Tie response of pendulus angles (ultiple layers sliding ode control). Fig. 5: sliding surfaces Fig. 6: Control output Fig. 7: Tie response of carts positions and pendulus angles (Pole assignent control) 367

Mollabashi et al.,013 Fig. 8: Tie response of carts positions and pendulus angles (LQR) VII. CONCLUSION Multiple layers sliding ode control (MLSMC), LQR and Pole assignent control ethod has been proposed in this paper. Siulation results were presented. In LQR ethod, SISO syste has to be considered and the wagon (cart) position will be forgotten while in the ulti-layer sliding ode ethod, cart position & pendulu are controlled siultaneously. Siulation results have shown that the all sliding surfaces are asyptotically stable. This approach has acceptable control effort. REFERENCES 1. Nieann and J.K. Poulsen, Analysis and design of controllers for a double inverted pendulu, Proceedings of Aerican Control Conference, vol. 4, pp. 803-808, June 003. T. Fuinaka, Y. Kishida, M.Yoshioka, and S. Oatu, Stabilization of double inverted pendulu with self-tuning neuro-pid, Proceedings of the IEEE-INNS-ENNS International Joint Conference on Neural Networks, vol. 4, pp. 345-348, July 000. 3. T. Sugie J. Yi, N. Yubazaki, and K. Hirota, Stabilization Control of Series-Type Double Inverted Pendulu Systes Using the SIRMs Dynaically Connected Fuzzy Inference Model, Artificial Intelligence in Engineering, vol. 15, pp.97-308, 001 4. H. Ebrahii, A. Shahansoorian, S. Rastegarpour, A. H. Mazinan, New approach to control of ball and bea syste and optiization with genetic algorith, Life Sci J, 013 5. Ch. Lin, and Y. Mon, Decoupling control by hierarchical fuzzy sliding-ode controller, IEEE Transactions on Control Systes Technology, vol. 13, pp. 593-598, July 005. 6. Xiucheng Dong, Zhang Zhang, Jiagui Tao, Design of Fuzzy Neural Network Controller Optiized by GA for Ball and Plate Syste, Sith International Conference on Fuzzy Systes and Knowledge Discovery, 009. 7. M. Moghaddas, M. R. Dastran, N. Changizi, N. Khoori, Design of Optial PID Controller for Inverted PenduluUsing Genetic Algorith, International Journal of Innovation, Manageent and Technology, Vol. 3, No. 4, August 01. 368