Lecture Notes in Control and Information Sciences Editor: M. Thoma
244
Springer London Berlin Heidelberg New York Barcelona I-Iong Kong Milan Paris Santa Clara Singapore Tokyo
H. Nijmeijer and T.I. Fossen (Eds)
New Directions in Nonlinear Observer Design
~ Springer
Series Advisory Board A. B e n s o u s s a n • M.]. G r i m b l e J.L. M a s s e y • Y.Z. T s y p k i n
• P. K o k o t o v i c
• H. K w a k e r n a a k
Editors H. Nijmeijer F a c u l t y o f M a t h e m a t i c a l S c i e n c e s , U n i v e r s i t y o f T w e n t e , P O B o x 217, 7500 A E E n s c h e d e , T h e N e t h e r l a n d s T.I. F o s s e n Department of Engineering Cybernetics, Norwegian University of Science and Technology, N-7034 Trondheim, Norway
ISBN 1-85233-134-8 Springer-Verlag L o n d o n Berlin Heidelberg British Library Cataloguing in Publication Data New directions in nonlinear observer design. - (Lecture notes in control and information sciences ; 224) 1.Observers (Control theory) 2.Nonlinear control theory 3.Feedback control systems l.Nijmeijer, Henk, 1955- II.Fossen, Thor I. 629.8'36 ISBN 1852331348 Library of Congress Cataloging-in-Publication Data New directions in nonlinear observer design / H. Nijmeijer and T.I. Fossen (eds.). p. cm. - (Lecture notes in control and information sciences ; 244) Includes bibliographical references and index. ISBN 1-85233-134-8 (alk. Paper) 1.Observers (Control theory)--Congresses. 2. Nonlinear control Theory--Congresses. I. Nijmeijer, H. (Henk), 1955- . II. Fossen, Thor I. III. Series. QA402.3.N487 1999 99-12174 629.8'312--dc21 CIP Apart from any fair dealing for the purposes of research or private study, or criticism or review, as permitted under the Copyright, Designs and Patents Act 1988, this publication may only be reproduced, stored or transmitted, in any form or by any means, with the prior permission in writing of the publishers, or in the case of reprographic reproduction in accordance with the terms of licences issued by the Copyright Licensing Agency. Enquiries concerning reproduction outside those terms should be sent to the publishers. © Springer-Verlag London Limited 1999 Printed in Great Britain The use of registered names, trademarks, etc. in this publication does not imply, even in the absence of a specific statement, that such names are exempt from the relevant laws and regulations and therefore free for general use. The publisher makes no representation, express or implied, with regard to the accuracy of the information contained in this book and cannot accept any legal responsibility or liability for any errors or omissions that may be made. Typesetting: Camera ready by contributors Printed and bound at the Atheneum Press Ltd., Gateshead, Tyne & Wear 69/3830-543210 Printed on acid-free paper
vi
Acknowledgments The editors are grateful to: S t r a t e g i c U n i v e r s i t y P r o g r a m (SUP) in M a r i n e C y b e r n e t i c s at the Norwegian University of Science and Technology (NTNU), Departments of Engineering Cybernetics, Marine Hydrodynamics and Marine Strutures (Professor Dr.-Ing. Olav Egeland, Program Man-
ager). • A B B (Professor Dr.-Ing. Asgeir J. SCrensen, Technology Manager -
Business Area Marine and Turbochargers) for their financial support. The authors want to thank all the workshop contributors for contributing to this book project. Finally, Mrs. Alison Jackson at Springer-Verlag London should be thanked for editorial suggestions and for helping us with general publishing questions.
Trondheim, February 1999 Enschede, February 1999
Thor I. Fossen Henk Nijmeijer
Contributors Alcorta Garcia, E., Department of Measurement and Control, University of Duisburg, Duisburg, Germany. Ashton, S. A., School of MIS, Coventry University, U.K. Astolfi, A., Centre for Process Systems Engineering, Imperial College of Science, London, U.K. Bastin, G., Centre for Systems Engineering and Applied Mechanics, Universite Catholique de Louvain, Louvain-La Neuve, Belgium. Battilotti, S., Dipartimento di Informatica e Sistemistica, Universit~ di Roma "La Sapienza", Italy. Besan~on, G., Laboratoire d'Automatique de Grenoble, ENSIEG, SaintMartin d'H~res, France. Blanke, M., Department of Automatic Control, Aalborg University, Denmark. Canudas de Wit, C. Laboratoire d'Automatique INPG, ST. Martin d'H~res, France.
de Grenoble, ENSIEG-
Cruz, C., Department of Electronics ~ Telecom., Scientific Research and Advanced Studies Center of Ensenada (CICESE), M~xico. Deng, H., Department of Applied Mechanics and Engineering Sciences University of California at San Diego, La Jolla, USA. Egeland, O., Department of Engineering Cybernetics, Norwegian University of Science and Technology, Trondheim, Norway. El Bahir, L., Department of Control Engineering, Universit~ Libre de Bruxelles, Brussels, Belgium. El Yaagoubi, E. H., LCPI ENSEM
Cassablanca, Morocco.
Fossen, T. I., IDepartment of Engineering Cybernetics, Norwegian University of Science and Technology, Trondheim, Norway and 2ABB Industri AS, Marine Division, Oslo, Norway.
Vlll
Frank, P. M., Department of Measurement Duisburg, Duisburg, Germany.
and Control, University of
Glumineau, A. Institut de Recherche en Cybern~tique de Nantes, France. Hammouri, H., LAGEPT
University of Lyon, France.
Huijberts, H. J. C., Department of Mathematics and Computing Science, Eindhoven University of Technology, The Netherlands. Horowitz, R. Department of Mechanical Engineering, University of California, Berkeley, CA, U.S.A. Isidori, A., IDepartment of Systems Science and Mathematics, Washington University, St. Louis, USA and 2Dipartimento di Informatica e Sistemistica, Universit~t di Roma "La Sapienza", Italy. Izadi-Zamanabadi, R., Department of Automatic Control, Aalborg University, Denmark. Jiang, Z.-P., Department of Electrical Engineering, Polytechnic University, Brooklyn, U.S.A. Junge, L., Drittes Physikalisches Institut, Universitttt G6ttingen, Germany. Khalil, H. K., Department of Electrical and Computer Engineering, Michigan State University, USA. Kinnaert, M., Department of Control Engineering, Universit~ Libre de Bruxelles, Brussels, Belgium. Kocarev, L., Department of Electrical Engineering, St Cyril and Methodius University, Skopje, Macedonia. Kristiansen, D., Department of Engineering Cybernetics, Norwegian University of Science and Technology, Trondheim, Norway. Krstid, M., Department of Applied Mechanics and Engineering Sciences University of California at San Diego, La Jolla, USA. Lilge, T., Institut flit Regelungstechnik, University of Hannover, Hannover, Germany. Lohmiller, W., Nonlinear Systems Laboratory, Massachusetts Institute of Technology, Cambridge, Massachusetts, USA. Ldpez-Morales, V., Institut de Recherche en Cybern~tique de Nantes, France.
ix Loria, A., Laboratoire d'Automatique de Grenoble, ENSIEG, St. Martin d'H~res, France. Nijmeijer, H., 1Faculty of Mathematical Sciences, Dept. of Systems, Signals and Control, University of Twente and 2Faculty of Mechanical Engineering, Eindhoven University of Technology, The Netherlands. Ortega, R., Laboratoire des Signaux et Syst~mes, Ecole Sup6rieure d'Electricit6, Paris, Prance. Panteley, E., I.N.R.I.A., Rh6ne Alpes, St. Martin d'Hfires, France. Parlitz, U., Drittes Physikalisches Institut, Universitat GSttingen, Germany. Pettersen, K. Y., Department of Engineering Cybernetics, Norwegian University of Science and Technology, Trondheim, Norway. Praly, L., Centre Automatique et Syst~mes, t~cole des Mines de Paris, Fontainebleau, prance. Rodrigues-Cortes, H., Laboratoire des Signaux et Syst~mes, Ecole Sup~rieure d'Electricit~, Paris, prance. Schaffner, J., Institute for Systems, Informatics and Safety, European Commission Joint Research Centre, Ispra, Italy Schreier, G., Department of Measurement and Control, University of Duisburg, Duisburg, Germany. Shields, D. N., School of MIS, Coventry University, U.K. Shiriaev, A., Department of Engineering Cybernetics, Norwegian University of Science and Technology, Trondheim, Norway. Slotine, J. J. E., Nonlinear Systems Laboratory, Massachusetts Institute of Technology, Cambridge, Massachusetts, USA. Strand, J. P., ABB Industri AS, Marine Division, Oslo, Norway. Teel, A., Department of Electrical and Computer Engineering, University of California, Santa Barbara, USA. Tsiotras, P., Georgia Institute of Techology, School of Aerospace Eng., Atlanta, Georgia, USA. Vik, B. Department of Engineering Cybernetics, Norwegian University of Science and Technology, Trondheim, Norway. Zeitz, M., Institut ftir Systemdynamik of Stuttgart, Germany.
und Regelungstechnik, University
Contents Nonlinear Observer Design A Viewpoint on Observability Nonlinear Systems
and
Observer
Design
for 3
G. Besanf~on 1 2 3
Introduction . . . . . . . . . . . . . . . . . . . . . . . . . . . Basic Definitions a n d P r o p o s e d "Classification" . . . . . . . E x a m p l e s of N o n U n i f o r m a n d U n i f o r m O b s e r v a t i o n . . . . 3.1 N o n U n i f o r m O b s e r v a t i o n : the Case of State-Affine Systems . . . . . . . . . . . . . . . . . . . . . . . . . 3.2 U n i f o r m O b s e r v a t i o n : the Case of U n i f o r m l y O b s e r v able Systems . . . . . . . . . . . . . . . . . . . . . . 3.3 A n E x a m p l e of U n i f o r m O b s e r v a t i o n of N o n - u n i f o r m l y observable S y s t e m s . . . . . . . . . . . . . . . . . . . Observer I n t e r c o n n e c t i o n . . . . . . . . . . . . . . . . . . . S t a t e T r a n s f o r m a t i o n s a n d Observer Design . . . . . . . . . Conclusions . . . . . . . . . . . . . . . . . . . . . . . . . . . References . . . . . . . . . . . . . . . . . . . . . . . . . . . .
Model-Based
Observers
for
Tire/Road
Contact
1
3 4 5
7 8 9 11 15 20 20
Friction
Prediction C. Canudas de Wit, R. Horowitz and P. Tsiotras
2
3 4 7
Introduction . . . . . . . . . . . . . . . . . . . . . . . . . . . T i r e - r o a d Friction Models . . . . . . . . . . . . . . . . . . . 2.1 P s e u d o - S t e a d y S t a t e Models . . . . . . . . . . . . . 2.2 L u m p e d D y n a m i c Models . . . . . . . . . . . . . . . 2.3 D i s t r i b u t e d D y n a m i c Models . . . . . . . . . . . . . 2.4 Relation Between Distributed Dynamical Model and the Magic F o r m u l a . . . . . . . . . . . . . . . . . . . Problem Formulation . . . . . . . . . . . . . . . . . . . . . . G e n e r a l Observer Design . . . . . . . . . . . . . . . . . . . . A p p l i c a t i o n to the O n e - W h e e l Model . . . . . . . . . . . . . 5.1 Simulation Results . . . . . . . . . . . . . . . . . . . Conclusions . . . . . . . . . . . . . . . . . . . . . . . . . . . References . . . . . . . . . . . . . . . . . . . . . . . . . . . .
23 23 25 26 28 29 30 32 33 36 39 40 41
xii
Observer D e s i g n for Nonlinear D. Kristiansen and O. Egeland Introduction . . . . . . . . . . 1 Contraction Theory . . . . . 2 System Equations . . . . . . . 3 4 5
6 7
Oscillatory S y s t e m s
. . . . . . . . . . . . . . . . . . 3.1 Analysis . . . . . . . . . . . . . . O b s e r v e r Design . . . . . . . . . . . . . Simulations . . . . . . . . . . . . . . . . 5.1 E x a m p l e 1: 2 - D O F O s c i l l a t o r y Nonlinearities . . . . . . . . . . . 5.2 E x a m p l e 2: C y l i n d e r G y r o s c o p e Conclusions . . . . . . . . . . . . . . . . References . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . System with . . . . . . . . ............ . . . . . . . . . . . . . . . .
Transformation to State Affine S y s t e m Design A. Glumineau and V. Ldpez-M. Introduction . . . . . . . . . . . . . . . . . . . 1 Defi n i t i o n s a n d N o t a t i o n . . . . . . . . . . . . 2 Problem Statement . . . . . . . . . . . . . . . 3
4
5 6
and
Observers
1 2
. . . . . .
43 44 46 47 49 51 51 52 56 57
Observer
. . . . . . . . . . . . . . . . . . . . . for S t a t e A t t i n e . . . . . . . ........ ........ . . . . . . . . . . . . . . . . . . . . . . . . . . . .
59 60 61 61 62 65 66 67 68 69
f o r N o n l i n e a r Discrete73
Introduction . . . . . . . . . . . . . . . . . . . . . . Differential F o r m s . . . . . . . . . . . . . . . . . . O b s e r v e r D e s i g n using O b s e r v e r F o r m s . . . . . . . . . . . . O b s e r v e r Design using E x t e n d e d O b s e r v e r F o r m s Conclusions . . . . . . . . . . . . . . . . . . . . . . References . . . . . . . . . . . . . . . . . . . . . . .
Stability Analysis and Observer Diffusion P r o c e s s e s W. Lohmiller and J.-J. E. Slotine
. . . . . . . . . . . . . . . . . . Cubic . . .
59
. . . 3.1 T h e I n p u t - O u t p u t Differential E q u a t i o n Systems ~a - . . . . . . . . . . . . . . . 3.2 S t a t e Affine T r a n s f o r m a t i o n A l g o r i t h m S y n t h es i s O b s e r v e r for S t a t e Affine S y s t e m s 4.1 Physical Example . . . . . . . . . . . . 4.2 Simulation Results . . . . . . . . . . . . Conclusions . . . . . . . . . . . . . . . . . . . . References . . . . . . . . . . . . . . . . . . . . .
On E x i s t e n c e o f E x t e n d e d Time Systems H. J. C. Huijberts
43
Design
. . . . . . . . . . ...... . . . . . . . . . .
73 75 79 84 90 91
for N o n l i n e a r
Introduction . . . . . . . . . . . . . . . . . . . . . . . . . . . Contraction Analysis . . . . . . . . . . . . . . . . . . . . . . 2.1 Basic Tools . . . . . . . . . . . . . . . . . . . . . . .
93 93 94 94
xiii
4 5 6 A
2.2 N o n l i n e a r O b s e r v e r Design using C o n t r a c t i o n T h e o r y 2.3 Weakly Contracting Systems . . . . . . . . . . . . . N o n l i n e a r Diffusion E q u a t i o n s . . . . . . . . . . . . . . . . . 3.1 C o n t r a c t i o n P r o p e r t i e s of R e a c t i o n - D i f f u s i o n P r o cesses . . . . . . . . . . . . . . . . . . . . . . . . . . 3.2 Observer Design for N o n l i n e a r Diffusion Processes Spatial Discretization and Numerical Implementation . . . . Further Extensions . . . . . . . . . . . . . . . . . . . . . . . References . . . . . . . . . . . . . . . . . . . . . . . . . . . . C o m p u t a t i o n of C o n t r a c t i o n R a t e s . . . . . . . . . . . . . .
96 97 99 100 103 104 105 109 109
N o n l i n e a r P a s s i v e O b s e r v e r D e s i g n for S h i p s w i t h A d a p t i v e
Wave Filtering J. P. Strand and T. L Fossen 1 2
3
4
5 6 7
113
Introduction . . . . . . . . . . . . . . . . . . . . . . . Modeling . . . . . . . . . . . . . . . . . . . . . . . . 2.1 Kinematics . . . . . . . . . . . . . . . . . . . 2.2 Vessel D y n a m i c s . . . . . . . . . . . . . . . . . . . . 2.3 T o t a l Ship Model . . . . . . . . . . . . . . . . . . . . N o n - A d a p t i v e Observers . . . . . . . . . . . . . . . . . . . . 3.1 Observer i n the E F frame . . . . . . . . . . . . . . . 3.2 Augmented Observer . . . . . . . . . . . . . . . . . . A d a p t i v e Observer . . . . . . . . . . . . . . . . . . . 4.1 A d a p t i v e Observer E q u a t i o n s . . . . . . . . . . . . . 4.2 A d a p t i v e Observer Error D y n a m i c s . . . . . . . . . . 4.3 Stability a n d P a s s i v i t y . . . . . . . . . . . . . . . . . Experimental Results . . . . . . . . . . . . . . . . . . . . . . Conclusions . . . . . . . . . . . . . . . . . . . . . . . References . . . . . . . . . . . . . . . . . . . . . . . .
Nonlinear INS
Observer
Design
for I n t e g r a t i o n
. . . . . . . . . . . .
113 115 115 115 118 118 119 123 125 126 126 126 128 130 133
. . . .
. . . . . . . .
of DGPS
and
135
B. Vik, A. Shiriaev and T. L Fossen 1
2 3
4
5
Introduction . . . . . . . . . . . . . . . . . . . . . . 1.1 Nomenclature . . . . . . . . . . . . . . . . . 1.2 Motivation . . . . . . . . . . . . . . . . . . Review of G P S F u n d a m e n t a l s . . . . . . . . . . . . . . . . . Strapdown Equations ..................... 3.1 Local F r a m e R e p r e s e n t a t i o n . . . . . . . . . . . . . . 3.2 Earth Frame Representation ............. 3.3 A n g u l a r Velocity E q u a t i o n s . . . . . . . . . . . . . . N o n l i n e a r Observer Design . . . . . . . . . . . . . . . . . . . 4.1 A n g u l a r Velocity Observer . . . . . . . . . . . . . . . 4.2 Velocity a n d P o s i t i o n Observers . . . . . . . . . . . . Case S t u d y . . . . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . .
. . . . .
135 135 136 138 140 140 141 142 142 143 145 157
xiv
6
Conclusions and Future Work
7
References . . . . . . . . . . . . . . . . . . . . . . . . . . . .
Variants
of Nonlinear
Normal
. . . . . . . . . . . . . . . . .
Form
Observer
158 158
161
Design
J. Schaffner and M. Zeitz Introduction . . . . . . . . . . . . . . . . . . . . . . . . . . . 1 Normal Form Observer . . . . . . . . . . . . . . . . . . . . . 2 Continuous Observer . . . . . . . . . . . . . . . . . . . . . . 3 Extended Luenberger Observer . . . . . . . . . . . . . . . . 4 Block-Triangular Observer . . . . . . . . . . . . . . . . . . . 5 Conclusions . . . . . . . . . . . . . . . . . . . . . . . . . . . 6 References . . . . . . . . . . . . . . . . . . . . . . . . . . . . 7
1
167 171 179 179
181
Output Feedback Control Design
II
161 162 163
Separation Results for Semiglobal Stabilization Nonlinear Systems via Measurement Feedback
of 183
S. Battilotti 1
2 3
Introduction . . . . . . . . . . . . . . . . . . . . . . . . . . . Notations . . . . . . . . . . . . . . . . . . . . . . . . . . . . Regional Stabilization via Measurement Feedback ......
183 185 186
3.1 3.2 3.3
186 191
Tools . . . . . . . . . . . . . . . . . . . . . . . . . . Applications . . . . . . . . . . . . . . . . . . . . . . S e m i g l o b a l S t a b i l i z a t i o n of U n c e r t a i n N o n l i n e a r S y s tems . . . . . . . . . . . . . . . . . . . . . . . . . . .
References . . . . . . . . . . . . . . . . . . . . . . . . . . . . Observer-Controller
Design
for
Global
Tracking
of
N o n h o l o n o m i c Systems Z.-P. Jiang and H. Nijmeijer Introduction . . . . . . . . . . . . . . . . . . . . . . . . . . . 1 Problem Statement . . . . . . . . . . . . . . . . . . . . . . . 2 Reduced-Order Observer . . . . . . . . . . . . . . . . . . . . 3 Output-Feedback Design . . . . . . . . . . . . . . . . . . . . 4 4.1 Backstepping-Based Trackers . . . . . . . . . . . . . 4.2 A Modification . . . . . . . . . . . . . . . . . . . . . Example: A Knife-Edge . . . . . . . . . . . . . . . . . . . . Conclusions and Future Work . . . . . . . . . . . . . . . . . References . . . . . . . . . . . . . . . . . . . . . . . . . . . .
3
196 205
Separation Principle f o r a C l a s s o f Euler-Lagrange Systems
207 207 208 210 212 213 217 219 225 226
A
229
A. Loria and E. Panteley 1
Introduction
. . . . . . . . . . . . . . . . . . . . . . . . . . .
229
xix
IV
Synchronization
467
and Observers
1 Synchronization Through E x t e n d e d Kalman Filtering
469
C. Cruz and H. Nijmeijer Introduction . . . . . . . . . . . . . . . . . . . . . . . . . . . 1 A n E x t e n d e d K a l m a n F i l t e r as Receiver . . . . . . . . . . . 2 Examples . . . . . . . . . . . . . . . . . . . . . . . . . . . . 3 3.1 Synchronization .................... 3.2 Secure C o m m u n i c a t i o n . . . . . . . . . . . . . . . . . Concluding Remarks . . . . . . . . . . . . . . . . . . . . . . References . . . . . . . . . . . . . . . . . . . . . . . . . . . .
2 Nonlinear Discrete-Time
469 472 479 479 483 487 488
Observers for Synchronization
Problems
491
T. Lilge 1 2 3 4
7 8
Introduction . . . . . . . . . . . . . . . . . . . . . . . . . . . S t a t e E q u i v a l e n c e to a S y s t e m in E x t e n d e d O b s e r v e r F o r m Observer Design via E x t e n d e d Observer F o r m . . . . . . . . A l t e r n a t i v e Observer S t r u c t u r e s via E O F . . . . . . . . . . 4.1 Observer E q u a t i o n s . . . . . . . . . . . . . . . . . . 4.2 M a i n C h a r a c t e r i s t i c s of t h e Observers . . . . . . . . A n E x a m p l e in the F i e l d of C o m m u n i c a t i o n . . . . . . . . . Observer Design for the R6ssler S y s t e m . . . . . . . . . . . 6.1 Observer Design in C o n t i n u o u s - T i m e . . . . . . . . . 6.2 Observer Design i n D i s c r e t e - T i m e . . . . . . . . . . 6.3 Observer Errors for Slow E r r o r D y n a m i c s . . . . . . . 6.4 Observer Errors for Fast E r r o r D y n a m i c s . . . . . . 6.5 Concluding Remarks .................. Discussion a n d C o n c l u s i o n s . . . . . . . . . . . . . . . . . . References . . . . . . . . . . . . . . . . . . . . . . . . . . . .
511
Chaos Synchronization U. Parlitz, L. Junge and L. Kocarev Introduction . . . . . . . . . . . . . . . . . . . . . 1 S y n c h r o n i z a t i o n of S p a t i a l l y E x t e n d e d S y s t e m s 2 Generalized Synchronization . . . . . . . . . . . . . . . . . . 3 Phase Synchronization ..................... 4 Conclusions . . . . . . . . . . . . . . . . . . . . . 5 References . . . . . . . . . . . . . . . . . . . . . . 6
491 494 497 499 499 500 501 503 505 506 506 507 508 509 509
. . . . . . .......
. . . . . . . . . . . .
511 512 515 518 522 522
XV
4 5 6 A 4
Model a n d P r o b l e m F o r m u l a t i o n . . . . . . . . . . . . . . . A Cascades A p p r o a c h to a S e p a r a t i o n P r i n c i p l e . . . . . . . 3.1 Observer Design . . . . . . . . . . . . . . . . . . . . 3.2 S t a t e Feedback C o n t r o l l e r . . . . . . . . . . . . . . . 3.3 A Separation Principle . . . . . . . . . . . . . . . . . A p p l i c a t i o n to R o b o t M a n i p u l a t o r s . . . . . . . . . . . . . . Conclusions . . . . . . . . . . . . . . . . . . . . . . . . . . . References . . . . . . . . . . . . . . . . . . . . . . . . . . . . A T h e o r e m o n U G A S for Strictly Passive S y s t e m s . . . . .
High-Gain
Observers
in Nonlinear
Feedback
232 234 235 236 237 240 243 244 246 249
Control
H. K. Khalil 1 2 3 4 5 6 7 8 9 10 11 5
Introduction . . . . . . . . . . . . . . . . . . . . . . . Motivating Example . . . . . . . . . . . . . . . . . . Separation Principle . . . . . . . . . . . . . . . . . . S t a b i l i z a t i o n a n d Semiglobal S t a b i l i z a t i o n . . . . . . . . . . Nonlinear Servomechanisms . . . . . . . . . . . . . . . . . . Adaptive Control . . . . . . . . . . . . . . . . . . . . Sliding Mode C o n t r o l . . . . . . . . . . . . . . . . . . U n m o d e l e d Fast D y n a m i c s . . . . . . . . . . . . . . . . . . Discrete-Time Implementation ................ A p p l i c a t i o n to I n d u c t i o n Motors . . . . . . . . . . . . . . . References . . . . . . . . . . . . . . . . . . . . . . . .
Output-Feedback tems
Control
of
Stochastic
. . . . . . . . . . . .
. . . . . . . .
. . . .
Nonlinear
Feedback
Sys269
M. Krstid and H. Deng Introduction . . . . . . . . . . . . . . . . . . . . . . . . 1 P r e l i m i n a r i e s on Stochastic S t a b i l i t y . . . . . . . . . . . . . 2 O u t p u t - F e e d b a c k S t a b i l i z a t i o n in P r o b a b i l i t y . . . . . . . . 3 Output-Feedback Noise-to-State Stabilization . . . . . . . . 4 Output-Feedback Adaptive Stabilization ........... 5 References . . . . . . . . . . . . . . . . . . . . . . . . . 6 P r o o f . . . . . . . . . . . . . . . . . . . . . . . . . . . . A P r o o f . . . . . . . . . . . . . . . . . . . . . . . . . . . . B P r o o f . . . . . . . . . . . . . . . . . . . . . . . . . . . . C Output
249 250 255 258 259 261 262 262 263 263 264
Control of Food-Chain
. . .
. . . .
. . . .
. . . .
Systems
R. Ortega, A. Astolfi, G. Bastin and H. Rodrigues Cortes Introduction . . . . . . . . . . . . . . . . . . . . . . . . . . . 1 C o n t r o l l e r Design P r o c e d u r e . . . . . . . . . . . . . . . . . . 2 S t a t e - F e e d b a c k C o n t r o l of a Simple P r e y - P r e d a t o r S y s t e m 3 Output-Feedback Stabilization ................ 4 M ain Result . . . . . . . . . . . . . . . . . . . . . . . . . . . 5 S i mulations . . . . . . . . . . . . . . . . . . . . . . . . . . . 6
269 270 271 276 280 284 287 288 289 291 291 292 295 299 301 305
xvi 7 8 A 7
8
Concluding Remarks . . . . . . . . . . . . . . . . . . . . . . References . . . . . . . . . . . . . . . . . . . . . . . . . . . . Maple Code . . . . . . . . . . . . . . . . . . . . . . . . . . .
306 307 308
O u t p u t Feedback Tracking Control for Ships
311
K. Y. Pettersen and H. Nijmeijer Introduction . . . . . . . . . . . . . . . . . . . . . . . . . . . 1 T h e Ship M o d e l . . . . . . . . . . . . . . . . . . . . . . . . . 2 D e s i g n of a n O u t p u t F e e d b a c k T r a c k i n g C o n t r o l L a w . . . . 3 Simulations . . . . . . . . . . . . . . . . . . . . . . . . . . . 4 Bias E s t i m a t i o n . . . . . . . . . . . . . . . . . . . . . . . . . 5 S i m u l a t i o n s w i t h an E n v i r o n m e n t a l D i s t u r b a n c e . . . . . . 6 Conclusions and ~ t u r e Work . . . . . . . . . . . . . . . . . 7 References . . . . . . . . . . . . . . . . . . . . . . . . . . . . 8
311 313 314 319 324 327 329 331
D y n a m i c U C O Controllers and Semiglobal Stabilization o f U n c e r t a i n N o n m i n i m u m P h a s e S y s t e m s by O u t p u t Feedback 335 A. Isidori, A. R. Teel and L. Praly 1 2 3
4
5 6
III
Introduction . . . . . . . . . . . . . . . . . . . . . . . . . . . Preliminaries . . . . . . . . . . . . . . . . . . . . . . . . . . S t a b i l i z a t i o n of N o n m i n i m u m P h a s e S y s t e m s by O u t p u t F eed back . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 3.1 T h e R e l a t i v e D e g r e e O n e Case . . . . . . . . . . . . 3.2 T h e R e l a t i v e D e g r e e G r e a t e r t h a n O n e Case . . . . On Dynamic U C O Feedback . . . . . . . . . . . . . . . . . . 4.1 General Results . . . . . . . . . . . . . . . . . . . . . 4.2 A p p l i c a t i o n to N o n m i n i m u m P h a s e S y s t e m s . . . . . Conclusions . . . . . . . . . . . . . . . . . . . . . . . . . . . References . . . . . . . . . . . . . . . . . . . . . . . . . . . .
335 336 338 338 341 344 344 347 349 349
351
Fault Detection and Isolation
Fault D e t e c t i o n O b s e r v e r f o r a C l a s s o f N o n l i n e a r S y s t e m s 353 S. A. Ashton and D. N. Shields 1 2 3 4 5
6 7
Introduction . . . . . . . . . . . . . . . . . . . . . . . System Description . . . . . . . . . . . . . . . . . . . Observer Design . . . . . . . . . . . . . . . . . . . . General Detectability Conditions ............... Testable Detectability Conditions ............... 5.1 A S p e c ia l Class ( S t e p - F a u l t s ) . . . . . . . . . . . . . 5.2 Numerical Calculation Procedure ........... Concluding Remarks . . . . . . . . . . . . . . . . . . References . . . . . . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . .
. . . . . . . .
353 354 354 363 365 368 371 372 373
xvii
N o n l i n e a r Observer for Signal and P a r a m e t e r Fault D e t e c t i o n in Ship P r o p u l s i o n Control 375 M. Blanke and R. Izadi-Zamanabadi 1 2
Introduction . . . . . . . . . . . . . . . . . . . . . . . . . . . Ship P r o p u l s i o n S y s t e m . . . . . . . . . . . . . . . . . . . . 2.1 Propeller Thrust and Torque ............. 2.2 Diesel E n g i n e P r i m e M o v e r . . . . . . . . . . . . . .
375 376 377 377
2.3 2.4
Hull R e s i s t a n c e . . . . . . . . . . . . . . . . . . . . . A c t u a t o r s for Fuel I n j e c t i o n a n d P r o p e l l e r P i t c h . .
378 378
2.5
Sensors
. . . . . . . . . . . . . . . . . . . . . . . . .
378
3 4
Control Hierarchy . . . . . . . . . . . . . . . . . . . . . . . Structural Analysis . . . . . . . . . . . . . . . . . . . . . . . 4.1 D e s c r i p t i o n of t h e M o d e l . . . . . . . . . . . . . . . 4.2 Formal Representation . . . . . . . . . . . . . . . . . 4.3 Sensor Fusion for R e - c o n f i g u r a t i o n . . . . . . . . . .
379 380 380 380 381
5
I s o l a t i o n of Shaft S p e e d a n d E n g i n e F a u l t s ......... 5.1 Adaptive Observer . . . . . . . . . . . . . . . . . . . 5.2 I d e n t i f i c a t i o n of P r o p e l l e r P a r a m e t e r s . . . . . . . .
384 384 386
5.3
....
388
6
Fault Isolation . . . . . . . . . . . . . . . . . . . . . . . . . 6.1 Re-configuration . . . . . . . . . . . . . . . . . . . .
389 392
7
Simulation Results
. . . . . . . . . . . . . . . . . . . . . . .
394
8
Conclusions . . . . . . . . . . . . . . . . . . . . . . . . . . .
395
9
References . . . . . . . . . . . . . . . . . . . . . . . . . . . .
395
Nonlinear Observers for Fault D e t e c t i o n and Isolation P. M. Frank, G. Schreier and E. Alcorta Garcia Introduction . . . . . . . . . . . . . . . . . . . . . . . . . . . 1 Preliminaries . . . . . . . . . . . . . . . . . . . . . . . . . . 2 Observer-Based Residual Generation ............. 3
399
3.1 3.2 3.3 3.4 3.5 3.6 4
Identifiability from Usual Maneuvering D a t a
399 400 401 Nonlinear Identity Observer Approach ........ 401 N o n l i n e a r U n k n o w n I n p u t O b s e r v e r A p p r o a c h . . . 403 The Disturbance Decoupling Nonlinear Observer Approach . . . . . . . . . . . . . . . . . . . . . . . . . . 404 Adaptive Nonlinear Observer Approach ....... 406 T h e N o n l i n e a r F a u l t D e t e c t i o n F i l t e r A p p r o a c h . . . 408 O b s e r v e r for F a u l t D i a g n o s i s in B i l i n e a r S y s t e m s . . 410
Nonlinear Observer Design via Lipschitz Condition . . . . .
412
4.1 4.2 4.3
Observer Presentation . . . . . . . . . . . . . . . . . C o n t r i b u t i o n of this O b s e r v e r . . . . . . . . . . . . . Residual Generation . . . . . . . . . . . . . . . . . .
412 415 417
Conclusions . . . . . . . . . . . . . . . ............ References . . . . . . . . . . . . . . . . . . . . . . . . . . . .
418 418
XVlll
4
A p p l i c a t i o n o f N o n l i n e a r O b s e r v e r s t o Fault D e t e c t i o n a n d Isolation 423 H. Hammouri, M. Kinnaert and E.H. El Yaagoubi 1
Introduction . . . . . . . . . . . . . . . . . . . . . . . . . . .
423
2
R e s i d u a l G e n e r a t i o n for L i n e a r S y s t e m s
424
2.1
3
...........
Problem Statement . . . . . . . . . . . . . . . . . . .
424
2.2
Second Problem Formulation
425
2.3
P r i n c i p l e of t h e S o l u t i o n . . . . . . . . . . . . . . . .
.............
R e s i d u a l G e n e r a t i o n for N o n l i n e a r S y s t e m s
426 .........
428
3.1
Introduction
. . . . . . . . . . . . . . . . . . . . . .
428
3.2
Basic N o t i o n s . . . . . . . . . . . . . . . . . . . . . .
428
3.3
H i g h G a i n O b s e r v e r s for U n i f o r m l y O b s e r v a b l e Systems . . . . . . . . . . . . . . . . . . . . . . . . . .
429
3.4
T h e F h n d a m e n t a l P r o b l e m of R e s i d u a l G e n e r a t i o n for N o n l i n e a r S y s t e m s . . . . . . . . . . . . . . . . .
431
3.5
A p p l i c a t i o n of N o n l i n e a r O b s e r v e r s t o t h e F P R G
. .
Hydraulic System . . . . . . . . . . . . . . . . . . . . . . . .
434 437
4.1
M o d e l l i n g of t h e S y s t e m . . . . . . . . . . . . . . . .
437
4.2
Design of a R e s i d u a l G e n e r a t o r . . . . . . . . . . . .
438
5
Conclusions . . . . . . . . . . . . . . . . . . . . . . . . . . .
441
6
References . . . . . . . . . . . . . . . . . . . . . . . . . . . .
441
A
N u m e r i c a l Values used for t h e S i m u l a t i o n of t h e H y d r a u l i c System . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
443
I n n o v a t i o n G e n e r a t i o n for Bilinear S y s t e m s w i t h U n k n o w n 445
Inputs
M. Kinnaert and L. El Bahir 1
Introduction . . . . . . . . . . . . . . . . . . . . . . . . . . .
445
2
Problem Statement . . . . . . . . . . . . . . . . . . . . . . .
447
3
Design Procedure . . . . . . . . . . . . . . . . . . . . . . . .
448
4
Innovation Monitoring . . . . . . . . . . . . . . . . . . . . .
456
4.1
Introductory Remark . . . . . . . . . . . . . . . . . .
456
4.2
I n n o v a t i o n in t h e P r e s e n c e of A d d i t i v e F a u l t s . . . .
456
4.3
Generalized Likelihood Ratio Test
457
5
..........
D e s i g n a n d V a l i d a t i o n of a F D I S y s t e m for a t h r e e T a n k Process . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
459
5.1
Process Description
459
5.2
Design a n d V a l i d a t i o n of t h e I n n o v a t i o n G e n e r a t o r .
5.3
E v a l u a t i o n of t h e I n n o v a t i o n S e q u e n c e . . . . . . . .
. . . . . . . . . . . . . . . . . .
460 462
6
Conclusions . . . . . . . . . . . . . . . . . . . . . . . . . . .
463
7
References . . . . . . . . . . . . . . . . . . . . . . . . . . . .
463
A V i e w p o i n t on Observability and Observer Design for Nonlinear S y s t e m s Gildas Besan~on
ENSIEG
1
Laboratoire d ' A u t o m a t i q u e de Grenoble BP46 - 38402 Saint-Martin d'H~res, France
Introduction
Given a dynamical system, the observer aims at obtaining an estimate of the current state by only using available measurements. For linear systems, the property of observability, characterized by the K a l m a n rank condition, guarantees the possibility to indeed design an observer. In the case of nonlinear systems, observability is not enough, basically because this p r o p e r t y in general depends on the input of the system. In other words, observability of a nonlinear system does not exclude the existence of inputs for which two distinct initial states cannot be distinguished by using the knowledge of the measured output. This results in the fact t h a t in general, observer gains can be expected to depend on the applied input. Moreover, the existing observers generally tightly depend on some specific structure of the considered system. This chapter discusses such characteristics of observer design for nonlinear systems, basically following the recent work of [1]: on the basis of background definitions, the main observability requirements for observer design are first recalled in Section 2, so as to put into relief the various contexts which can be found. In particular, designs which are non uni.form w.r.t, the input are distinguished from those which are uniform, with a special attention paid to the case of uniform design for non uniformly observable systems in Section 3. Two directions of extension of available designs are then highlighted and illustrated, namely the possibility of interconnecting sub-observers to still obtain an observer in Section 4, and the issue of state transformation to make some observer design possible in Section 5. Some conclusions are finally given in Section 6.
4
2
1. A Viewpoint on Observability and Observer Design for Nonlinear Systems
Basic Definitions and Proposed "Classification"
Let us consider a nonlinear system defined by the following representation:
(~n~)
{~ = f(x,u) y
=
h(x)
x c ~ , u
9
y9
m
,
(1.1)
and let X~,(t, xo) denote its solution at time t, with initial condition x0 at time t = 0 and control u(t). Admissible inputs u(.) axe assumed to be taken in some set L / o f measurable and bounded functions. Observability can then be defined by the notion of indistinguishability [22] (see [11] for a synthesis). D e f i n i t i o n 1.1 Indistinguishability.
A pair (xo, ~o) will be said to be indistiguishable by u i.fVt > O, h(x~(t, xo)) =h(Xu( t, ~o) ). The pair is just said to be indistinguishable, i.f it is so .for any U.
From this definition, observability of (1.1) can be defined as follows: Definition 1.20bservability.
A nonlinear system (1.1) is observable if it does not have any indistinguishable pair o.f states. At this point, one can notice that from this definition, observability does not exclude the possible existence of inputs for which some states are indistinguishable. As an example, the following system: :~1
~
UX2
J:2
=
--x2
y
~
X1
(1.2)
is clearly observable, and yet u _= 0 makes every pair
indistinguishable. This means t h a t in general observability is not enough to be able to design an observer and t h a t the problem of inputs must be taken into account. A particular case of interest, is the case of inputs for which no indistinguishable pair can be found: D e f i n i t i o n 1.3 Universal inputs. An input u is universal on [0, t] i.f.for every pair of distinct states xo ~ 20, there exists T 9 [O,t] such that h(x~(7, xo)) ~ h(x~(7, 20)).
If u is universal on Kt +, it is just said to be universal.
1. A Viewpoint on Observability and Observer Design for Nonlinear Systems
5
From this definition, the notion of singular inputs can be derived: D e f i n i t i o n 1.4 Singular inputs. A non universal input is called singular. As one can guess from example (1.2) above, a typical class of systems which have singular inputs is the class of so-called state-affine systems of the following form:
y
= =
A(u)x Cx.
(1.3)
For such systems, one can define - as for linear time-varying systems - the following quantities: 9 the transition matrix @~(T, t) by: d(I)~('r, t) dT @~(t,t)
-
A(U(T))O~(T,t)
=
Id,
(1.4)
9 the observability Grammian F(t, T, u) by: F(t, T, u) :---
f
t+T
@T(T,t)cTV~2u(T,t)dT),
(1.5)
Jt
9 and some universality index "y(t, T, u), defined as the smallest elgenvalue of F(t, T, u). On this basis one can characterize inputs which are "universal enough" so that an observer design will be possible: D e f i n i t i o n 1.5 [10] Regularly persistent inputs. A n admissible input u is said to be regularly persistent .for system (1.3) if 3 T > O, a > O, and to > 0 such that 7 ( t , T , u ) >_ ~ for t >_ to. These remarks show that in general, the observer gain, as well as its stability property, depend on the input. In view of the above definitions, a particular case of special interest is the one of systems without singular inputs: D e f i n i t i o n 1.6 Uniformly observable systems. A system whose all inputs are universal is called uniformly observable. If, .for every t > O, all inputs are universal on [0, t], the system is locally uniformly observable. A class of "sufficiently regular" locally uniformly observable control affine systems have been characterized in [14]:
6
1. A Viewpoint on Observability and Observer Design for Nonlinear Systems
Theorem
1.1 [14] A n observable nonlinear system in the form:
= y
f(~)+ug(~)
=
(1.6)
with u = 0 as a universal input, and nonsingular Jacobian of ~(~) = (h(~),Lf(h(~)), ... L ~ - l ( h ( ~ ) ) ) at ~0, is locally uniformly observable at ~o i.f and only i.f the change of coordinates x = ~(~) turns it into the .following .form: Xl X2
= =
X2 + ~ I ( X l ) u X3 + ~ 2 ( X l , X 2 ) u
Xn--1
=
Xn+~n--I(Xl,...Xn--1)U
y
=
(1.7) =
+
xI []
Extensions to non-control-affine case mono and multi o u t p u t can be found in [15] and [12] respectively. For such systems, so-called high gain observers m a y exist [16], which are observers with gain and stability independent of the input. However, one can find several other cases of observers which have been proposed irrespective of the input, although the considered systems are not uniformly observable [21, 29, 13, 2]. The only possible explanation for such a phenomenon is t h a t in these cases, the difference between trajectories resulting from two distinct indistinguishable states naturally tends to zero. This is for instance what happens in system (1.2) : for this system u = 0 is singular insofar as it cannot distinguish
However, for such initial conditions and input, the error e2 on trajectories of x2 satisfies 42 = - e 2 , while t h a t of xl is identically zero, and thus, it is clear that the difference between the two trajectories asymptotically goes to zero. In this case, an observer irrespective of the input can be designed, simply as ~:2 = - x 2 Following the terminology of linear systems, this suggests to define some detectability property as follows: D e f i n i t i o n 1.7 Detectability. A nonlinear system (1.1) will be called detectable if for every couple ((2o, ~o), u(.) ) in (j~n • H:tn) • 5t such that there exists to .for which
1. A Viewpoint on Observability and Observer Design for Nonlinear Systems Vt _> to; h(x~(t, xo)) = h(x~(t, 5:0)) then IIx,,(t, xo) -
x=(t, ~0)ll
,0. t ---~oo
In the case of uncontrolled system, we only consider pairs of initial conditions. As a summary, in view of the above observability properties w.r.t, the inputs, one can distinguish the following cases in observer designs: 9 Either the system does not have singular inputs, and in t h a t case, one can hope to be able to design an observer irrespective of the input (uniform observation of uniformly observable systems), but m a y also only find an observer depending on the input (non uni.forTn observa-
tion of uniformly observable systems); 9 Or the system may have singular inputs, and in t h a t case possible observer designs will generally depend on the inputs (non uniform observation of non uniformly observable systems), except in special cases of systems which are detectable in the sense of definition 1.7
(uniform observation of non uniformly observable systems).
3 3.1
Examples of Non Uniform and Uniform Observation Non Uniform Observation: the Case of State-Affine Systems
Let us consider here a system described by the following equations:
y
= =
A(u)x + B(u), Cx
x C ~n, u C ~m y C P:tp.
(1.8)
For such a system, the observability generally depends on the input, and under appropriate excitation, an observer has been proposed with a gain indeed depending on u, as recalled below: 1.2 [10, 17] I.f u is regularly persistent for (1.8), and A(u), B(u) are uniformly bounded on the set of admissible inputs, then there exists 0o s.t. .for any 0 >_ 0o, the following system is an observer for (1.8):
Theorem
= So
= >
A(u)2 S - 1 c T ( c : ~ y) -~- B(~t) - 0 S - d ( u ) V S -- SA(u) + C T C O,
(1.9)
8
1. A Viewpoint on Observability and Observer Design for Nonlinear Systems
and V~ > 0, 30 > 0 : II~(t) - x(t)l I < A e x p ( - ~ t ) , .for some A > O. [] T h i s result c a n c l e a r l y b e e x t e n d e d t o t h e case of s y s t e m s in t h e f o r m ic = A ( s ) x + B(s) for a n y m e a s u r e d signal s w h i c h is r e g u l a r l y p e r s i s t e n t for k = A(s)x, for i n s t a n c e s = (u, y) [18]. W e p r e s e n t in S e c t i o n 4 a n o t h e r t y p e of e x t e n s i o n , b a s e d on i n t e r c o n n e c t i o n s of o b s e r v e r s in t h e form (1.9).
3.2
U n i f o r m O b s e r v a t i o n : the C a s e o f U n i f o r m l y O b s e r v a b l e Systems
W e consider h e r e a s y s t e m of t h e following form:
ic y
= =
A x + ~(x, u), C x e Kt
x C ~:tn, u E1R m (1.10)
0 1 ... 0 / withA=
". ". 0 andC= (1 0... 0 ). 0 ... 0 1 0 ... 0 U n d e r s t r u c t u r e c o n d i t i o n as in (1.7) - e n s u r i n g u n i f o r m o b s e r v a b i l i t y - a n d s o m e L i p s c h i t z c o n d i t i o n on ~, one c a n here d e s i g n a n o b s e r v e r w i t h a g a i n which is u n i f o r m w.r.t, u as recalled h e r e a f t e r ( w h e r e xi - resp. ~ i - d e n o t e s each c o m p o n e n t of x - resp. ~):
Theorem 1.3 [16] If: ,, ~ is globally Lipschitz w.r.t, x, uni.forTnly w.r.t, u; 9 ~xj = - - O , . f o r i = l , . . . n - l , j = i + l , . . . n . then there exists 00 such that for all 0 > 00, the .following system is an asymptotic observer .for (1.10): x 0 andV
> 0,30
= =
A 2 - S - 1 C T ( C 2 - y) + V ( } , u ) -OS- ATs - SA + cTc,
> 0 : Ilk(t) - x(t)ll _<
for some
(1.11)
> O. []
W e will use this r e s u l t in S e c t i o n 4 t o p r o p o s e a u n i f o r m o b s e r v e r for s o m e n o n u n i f o r m l y o b s e r v a b l e s y s t e m . B u t let us first i l l u s t r a t e t h i s p h e n o m e n o n in n e x t s u b s e c t i o n .
1. A Viewpoint on Observability and Observer Design for Nonlinear Systems
3.3
9
A n E x a m p l e o f U n i f o r m Observation of N o n - u n i f o r m l y observable S y s t e m s
To be able to find an observer which is non uniform w.r.t, the input for a system which is not uniformly observable, as well as a uniform observer for a system which is uniformly observable, is to some extent quite consistent. More impressive are cases of uni.form observers for non uniformly observable systems. An illustrative example of the phenomenon is given by the case of systems of the following form:
y
= =
Ax + f ( x , u ) Cx
(1.12)
for which one can find matrices K, D such t h a t
T=(
C
is invertible, ( K C + D)f(x, u) = cp(Cx, u), and A22 + NA12 is stable, with
( ~-T-~T-IA21 All A22 A12) . Such systems indeed, generally admit singular input (like system (1.2) for instance, for which D = (0 1) and K = 0 satisfy the above conditions, and u = 0 is a singular input), and yet: =
w
(A22 + KA12)z + ( K A u + A21 - (A22 + KA12)K)y + ~(y, u)
=
KC+D
z (1.13)
is an observer for (1.12) irrespective of the input [2]. Such systems in fact enjoy the following structure:
x= / All A21
A22
A
r
u)
' y = Cx = (Ip, O)x (1.14)
and as design Such in the
soon as A makes A22 - AA12 asymptotically stable, then one can an observer in the form (1.13) for (1.14). a property can in particular be used to design robust observers sense that the state estimation does not require the knowledge of
F(x,u). For instance, various manufacturing s y s t e m s admit a representation in the form (1.14), and an example can be found in [28] where the t h e r m a l
10
1. A Viewpoint on Observability and Observer Design for Nonlinear Systems
behaviour of some machine-tool spindle-bearing system is considered. Considering temperatures of the various elements involved as state variables, a numerical realization of the systems reads as follows:
---
+ y
=
(1
-8.000.10 5
2.982.10 -6
0.0421 0
-0.0325 2.483.10 -6
1.407.10 - s 0.008O 2.495.10 .5
) 0(u,x)
0)
0.0104 -1.724.10 -4
(1.15) (1.16)
00)x
where Q(u, x) is some inaccurate model of the friction heat flow. This system is thus in the form (1.14), with the nonlinear part in the form B1
B2 ) F(x,u) and one can check that here A = B_z B1 leaves A 2 2 - AA12 stable. Hence an observer can here be designed with complete decoupling of the uncertain part Q. Some more general conditions for such a design to be possible are given in [2], but a general formulation of the idea can be expressed as follows: P r o p o s i t i o n 1.1 If a nonlinear system:
y
=
f(x,u)
=
h(x)
(1.17)
can be transformed into: Zl
z
f l ( Z 1 , Z2, U)
~2 =
f2(zl,z2,~)
y
Zl
z
(1.18)
by change of coordinates z = O(x), such that .for any couple (u, Zl) of admissible functions and any pair of initial conditions z ~ ~ ~o we have ][X~u,zl)(t, z o) _ X~u,*i)(t, ~0)]] __~ 0 when t ---* ~ , then:
z2 =
f2(y, ~2,~) (1.19)
is an observer for (1.17).
1. A Viewpoint on Observability and Observer Design for Nonlinear Systems
11
This illustrates how an observer can be designed on the basis of some state transformation, here in some particular conditions ensuring detectability. Other results on state transformation for observer design are given in section 5.
4
Observer Interconnection
One way to extend the class of systems for which an observer can be designed is to interconnect observers in order to design an observer for some interconnected system, when possible. If indeed a system is not under a form for which an observer is already available, but can be seen as an interconnection between several subsystems each of which would a d m i t an observer if the states of the other subsystems were known, then a candidate observer for the interconnection of these subsystems is given by interconnecting available sub-observers. Notice t h a t in general, the stability of the interconnected observer is not guaranteed by that of each sub-observer, in the same way as separate designs of observer and controller do not in general result in some stable observer-based controller for nonlinear systems (no separation principle). However, Lyapunov-based sufficient conditions can be given so t h a t the existence of sub-observers results in t h a t of an interconnected observer [7]. Consider for instance the case of systems made of two subsystems of the following form:
it1 Y
:
= =
f l ( X l , X 2 , U ) , u C U C 1Rm; fi C ~ function, i = 1,2; f 2 ( x 2 , x l , u ) , x~ E X~ C ~ , i = 1,2; ( h i ( x 1 ) , h2(x2)) T = (Yl, Y2) T, Y~ E H~n~, i = 1,2. (1.20)
Assume also t h a t u(.) E U c / : o o ( ~ + , U), and set Xi := A C ( ~ + , ~ '~') the space of absolutely continuous function from ~7~+ into ~ n , . Finally, when i E {1, 2}, let ~ denote its complementary index in {1, 2}. The system (1.20) can be seen as the interconnection of two subsystems (Ei) for i = 1, 2 given by: (E~)
2~ = f~(xi,v~,u),
y~ = h~(x~),
(v~,u) e X~ x l~.
(1.21)
Assume t h a t for each system (Ei), one can design an observer (Oi) of the following form:
(Oi)
zi = fi(zi, v~, u) + ki(gi, z i ) ( h i ( z i ) - Yi),
gi = Gi(zi, v~, u, gi), (1.22)
for smooth ki, G~ and (zi, g~) E (~:~n~ x(~i), dT~ positively invariant by (1.22). T h e idea is to look for an observer for (1.20) under the form of the following
1. A Viewpoint on Observability and Observer Design for Nonlinear Systems
12
interconnection:
CO)
~ gi
f~(~, ~ , u) + ki(~, ~ci)(hi(~i) - yi); i = 1, 2; G~(2i, ~ , u, ~i); i -- 1, 2
=
(1.23)
Set ei := z~ - xi, and for any u C/4, v~ E A'i consider the following s y s t e m (where k~"(t) denotes gain ki(g~, zi) defined in (1.22)) :
c(~.... )
~
=
f~(z~,v~,u)+k~
(t)(h~(z~)
h~(z~-e~))
T h e n sufficient conditions for (1.23) to be an observer for (1.20) have b e e n expressed in [7] as follows: 1.4 [7] If.for i = 1,2, any signal u C Lt, v~ E A C ( ~ + , ~ n ~ ) , and any initial value rz0 [ i ,gi0~) E ~n~ x dg~, 3Vi(t, el), Wi(ei) positive de.finite .functions such that: Theorem
(i) Vx~ E X~;Ve~ E z~'~;Vt _> 0, ~
(t, ei) + ~
(t, ei)[fi(xi + ei, v~(t), u(t) ) - fi(xi, v~(t), u(t) ) +k~(t)(h~(xi + e~) - hi(xi))] ~ - W i ( e i )
(ii) 3a~ > 0;Yx~ C X~;Vx~ C ~ ; Y e ~
E ~';Ye~
C ~';Vt
>_ 0,
O~(t, e~)[f~(x~, x~ + e~, u(t)) - f~(x~, x~, u(t))] < ~ i ~ X / / - ~ e ~ ) , (iii) a~ + a2 < 2, then (1.23) is an asymptotic observer for (1.20). [] In the weaker case of cascade interconnection, n a m e l y when f l ( X l , x2, u) ---fl (x~, u) in (1.20), a s s u m p t i o n s can be weakened in the following way: Theorem
1.5 [7] Assume that:
L System :~1 fl(Xl,U); Yl = hi(x~) admits an observer (0~) as in (1.22) (without v2), s.t. Vu ~ Lt and Vxl(t) admissible trajectory of the system associated to u: ~-
lim el(t) = 0 a n d
Ile~(t)lldt < +o~
(with e~ :=
Z 1 -- Xl) ;
t ----~0 ( 3
(1.24)
IX. ~c > 0; Vu e U; Vx~ e X2, Ilf2(x2, xl,u)-f~(x2,x~,u){I
~ cllxl-X~lII,
1. A Viewpoint on Observability and Observer Design for Nonlinear Systems
13
III. Vu ELt, Vvl E A C ( f t +, ITtTM ), Vz2, o g2, o 3v(t, e2), w(e2) positive de.finite .functions s.t for every trajectory of ~(u'vl 2 with z2(O) = z ~ g2(O) = gO: (i) Vx2 E X2, e2 E j~n,2, t ~ O, ov
--~(t, e2) +
(t, e2)[f2(x2 + ee, vl(t),u(t)) - f~(x2,vl(t),u(t)) +k~ 1(t)(h2(x2 + e~) - h2(x2))] < -w(e~)
(ii) re2 E / R n2, t >_ O; v(t, e2) >_ z~(e2) (iii) Ve2 E Kgn2\B(O,r),t >_ O;
~--~eo(t, --o~
<_ A(l+v(t, e2(t))).for
.some constants ~,r > 0 and B(O,r) := {e2:11~211 _< ~}. Then: X1
fl (:~1, lt) Jr- k 1 (gl, :~l)(hl (Xl) - hi (Xl))
X2
f2( 1,
gl
- h (xl))
u) + k (02,
(1.25)
----
is an observer" .for (1.20) where fl (xl, x2, u) = f l (xl, u). [] In view of these conditions, and using available observers for systems in some particular forms, one might be able to design observers for further nonlinear systems. As an example, one can obtain in this way, and on the basis of observer (1.9) for system (1.8), a non uniform observer for a class of cascade block state affine systems of the following form:
~c
:bl x2
= =
Al(u,y)xl + Bl(u,y) A2(u,y, xl)x2 + B 2 ( u , y , xl)
2Cq Yl
~~-
Aq(u,y, xl,...Xq_l)Xq-]-Bq(U,y, CIZ1
yq
-~-
Cqxq
Xl,...Xq_l)
(1.26)
where xi E ~ n , : yi C zT~V~,u E ff~'~,y = ( y T ...yT)T = Cx and Ai,~i are continuous functions 9 Here the stability of the interconnected observer can only be guaranteed provided the inputs are "rich enough". Denoting by x~(t, xo) the projection of the solution onto llr~TM + ....... which takes components from 1 to nl + . . . ni of x, a~i(t, u, x0) the extended input
cx
(t, t ,x~
,
14
1. A Viewpoint on Observability and Observer Design for Nonlinear Systems
and B(u) the set {x c s II~(t,u,x)ll < c~, t e [ 0 , + ~ [ } of initial conditions generating bounded trajectories with u, we define this "richness" as: D e f i n i t i o n 1.8 Given E C 1l~"~, an input u will be said to be E - r e g u l a r l y persistent .for E~ if.for any compact K of E such that K A 13(u) ~ ~ there exist to > O, (~ > O, T > 0 such that: Vt>_to;VxEKAB(u), Theorem
Vi=ltoq-1,
~/(t,T,w~(t,u,x))>_a.
1.6 [~] Given E C 1Ft'~, assume that:
9 For i = 2 , . . . q, Ai, Wi are globally Lipsehitz w.r.t. ( X l , . . . x i - 1 ) uni.formly w.r.t. (u, y). 9 Input u is E-regularly persistent .for (1.26). 9 x(O) e E n u(u). then .for any ~ > O, there exist 01 > 0 , . . . ,0q > 0 and A > 0 such that the .following system: A1 (u, y)21 + ~ (u, y) - g~-IcT(c~&~ - yl) A2(u, y, ~,)~2 + ~2(u, y, &~) - S ~ c T ( c 2 2 2 - y2)
~E1
A q ( u , y, X l , . . .
Oc
~1
=
- - 0 ~ 1 -- A T ( ~ , y ) g l -02S2
~q
=
, Xq-1)Xq ~- (~:~q(U, y , : E l , . 9 . , : ~ q - 1 )
-
- glAI(~,y)
m~(u,y,2~)S2
-OqSq - AT (u,y,2l,
+ CyC~,
-
SqlCT(Cqxq
-- Yq)
g~(O) > 0
- S2A2(u,y, xl) + cTc2,
. . . ,~q-1)Sq - SqAq(u,y,~l,
g2(0)
>
0
. . . , ~ q - 1 ) + c T Cq,
gq(O) > 0 (1.27)
is an observer.for (1.26), with: ][2(t) - x(t)[] _< Ae -r [] The above design illustrates the case of cascade interconnection. As an example of "full interconnection" of observers, let us consider system of the following form: d:l X2 Yl Y2
= = = =
Alxl-b fl(Xl,U)+gl(xl,x2,u); A2(u)x2 ~ - f 2 ( x l , u) : : r ClXl C C2x2 C1R p
Xl C ]~ TM x2 E ~ n 2
(1.28)
with: (C1) A, C as in (1.10) and f ( x l , u ) Lipschitz assumptions;
satisfying uniform observability and
1. A Viewpoint on Observability and Observer Design for Nonlinear Systems
15
( 6 2 ) g(Xl,X2,U ) : ( 0 , . . . O, g n ( Z l , X 2 , U ) ) T and gn is globally Lipschitz w.r.t, xl (resp. x2), uniformly w.r.t. ( x 2 , u ) (resp. (Xl,U));
(C3) f2 is globally Lipschitz w.r.t, xl, uniformly w . r . t . u . For such a system, one can easily identify two subsystems for which (1.11) and (1.9) are candidate sub-observers, and on the basis of the associated Lyapunov functions [16, 17], one can check t h a t as soon as u is regularly persistent for ~ = A2(u)z, conditions of theorem 1.4 can be satisfied for 01 large enough. This gives an observer of the following form: X1 s x2 0 602
=
= -=
A13Cl q- fl(a?l, u) q- gl(~l, a:2, u) - - S l l C I T ( C l g C l Yl); A2(u):?2 + f2(:rl,U) - $21c2T(c2:c2 - y2); 01S1 -- A1Ts1 -- SIA1 + cT1c1 - 0 2 S 2 - d 2 ( u ) T & - S e A s ( u ) + C~C2; $2(0) > O.
Notice t h a t here the observer gain is non uniform due to the state affine p a r t of the system. But one could imagine a similar case where some uniform gain can be used, provided that detectability is guaranteed. As an example, consider system (1.28) again, now with 6'2 = 0 and p being some function now enjoying the following property: (C3') ~ is globally Lipschitz w.r.t. Xl, uniformly w.r.t. (u, x2) and there exists V positive definite s.t. V(~,e) 9 ~n2 , IIoy ll _< -9211ell and OV e ) + -~-(t, OV e)[~(~ + e , x(t), u ( t ) ) - ~(~, x(t), u(t))] _< -~111ell 2, for -57-(t, every admissible input function u and absolutely continuous function X. T h e n one can again check t h a t under conditions (C1), (C2), (C3'), an observer can be obtained as follows [7]: :~1 x2 0
5
= = :
A l X l q- f l ( X l , U ) q- gl(Xl,3:2, u) - S l l C 1 T ( C I : ~ I - y l ) qp(x2, :~1, u) -01S1 - ATs1 - SIA1 -/- cT1c1 .
(1.29)
S t a t e T r a n s f o r m a t i o n s and O b s e r v e r D e s i g n
One can notice t h a t observer designs presented till now are all based on a particular structure of the system. The subsequent idea is t h a t these designs also give state observers for systems which can be turned into one of these forms by change of state coordinates. We will call equivalent, two systems related by such a relationship: D e f i n i t i o n 1.9 Given xo E 1R n, a s y s t e m described by: 5c = y =
f(x,u)=fu(x)xe~n,u 9 h(x) 9 1Rp
"~ (1.30)
16
1. A Viewpoint on Observability and Observer Design for Nonlinear Systems
will be said to be e q u i v a l e n t at xo to the system: { ~
=
F(z,u)=F~(z)
y
=
H(z)
~f there exists a diffeomorphism z = q~(x) defined on some neighbourhood of xo such that: Vu
e/R m,
0q5 -~xf~(x) I~=o-l(z)= F~(z)
et
h o q5-1 --- H.
The interest of such a relationship for observer design is then motivated by the following proposition: P r o p o s i t i o n 1.2 Given two systems (El) and (E2) respectively defined
by: X(x,u) { ~ = Z(z,u) h(x) and(r2) y = H(z) and equivalent by z = C~(x), If: Z(~,u) + k ( w , g ( # ) (21)
{ ~ y
= =
(o~)
w
=
~-
=
x(:~,~)+
(v
=
F(w,u,y)
is an observer for (E2), Then: (o~)
{
y))
r(w,u,y)
(0o), ~
k, k(~,, h(:~) - y)
is an observer .for (El). This kind of remark has motivated various works on characterizing (rank observable) systems which can be turned into some "canonical form" for observer design, from the linear one up to output injection [23, 8, 24] to several forms of cascade block state afiine systems up to nonlinear injections from block to block [3, 26, 4, 5]. Using the formalism of differential forms [9] e.g. used in [19], we can indeed characterize systems equivalent to "special forms" of (1.26) (a general characterization would further require the use of explicit PDE's in its formulation). With the following notations:
9 d, L z , iz, A to respectively denote usual differentiation, Lie derivative along a vector field Z, inner product with Z and exterior product of differential forms; 9 d~v := dVl A . . . A d v , , and i x v := ( i x v l , . . . i x v ~ )
ifv = (vl,...v~);
1. A Viewpoint on Observability and Observer Design for Nonlinear Systems
17
9 i x ~ : = { i x w , w 9 f~}, Adf~ : = {wlA...Wd,Wi 9 Q}, df~ : = {dw,w 9 f~} if f~ is a set of differential forms; 9 f~ | O to denote the set of finite linear c o m b i n a t i o n s of elements of ft with coefficients in O; 9 i x w : = i x .... i x , . w if w is an (r + 1)-differential form, a n d X ( X 1 , . . . X ~) an r - t u p l e of vector fields;
=
9 (9(y) to d e n o t e the observability subspace of the considered s y s t e m with o u t p u t y, n a m e l y the smallest vectorial subspace of ~ which contains all o u t p u t functions, and is invariant u n d e r Lie derivation along the vector fields of the system, o b t a i n e d w h e n u describes ~ m ; let us privilege systems (E~,...~') of the following form:
A l ( u , y l ) z l + ~ l ( U , y 1) A 2 ( u ' y2, Z l ) Z 2 ~_ qp2 ( u , y 2 , ~.q
=
y
=
~'~1. . .7~q
Aq(u,
Zl )
yq, Z l , . . . Zq--1)Z q ~- r
y q , . . . Zq_l)
(1.31)
Cqzq ;q . U 9 j ~ m ~Zi 9 ~2~n.i y~ 9 H:C~, a s s u m e d to satisfy the following cascade rank observability condition at x0: for any x in some n e i g h b o u r h o o d of x0,
dimdO(yl)(x) difrtdO(y 2) A dnl O(yl )(x) d i m d O ( y q) A d TM O ( y l ) . . .
/~
dnq-lO(yq-1)(X)
~-
n 1
~.
n2
~-
nq
(1.32)
where ni E Pc'* such t h a t ~ i =q 1 ni = n. We will call those integers cascade observability indices. This c o n s t r u c t i o n means t h a t in (1.31), variables zl of each block are exclusively "observed" by o u t p u t hi, as soon as Z l , . . . zi-1 are k n o w n . T h e characterization of such systems will use the following tools: Given n .... Vm,q 9 fV*, V m - t u p l e s of functions y m = (y~n,...y~,~,,) a n d v , ~ - t u p l e s of vector fields X "~, for 1 < m < q, we define: 9 ~ ( y m ) the space such that dTl(y m) A d'""y "~ -= O, (f~x''(y~,.) = Span~{dLi.,,(y jfn, ) A d vl~~y rn, ,u E ~:~nq, ,1 <_ j -< /]m} | .~k+liY - . x ' ' . ,~,,) = Span~{diI..ix,,,~(~) A d'""ym,u E f~ m, [a~",.(ym)
~.~
..~',,.,
Lk=z~k
m,
[Y )
1. A Viewpoint on Observability and Observer Design for Nonlinear Systems
18
9 Oy~...y,,+l the space of functions such that: I . 9 rL n
m
(d"r
A
A
ix~x"
1
T~),+ 1
(YJ)) Ad~'""+lYm+I AdOY,::~,,,
=0,
j=l
9
f~'"'"(X;)
the space A ~ ~ ( d ' J y
j A A "j-~j
ix.~t~x"(yJ)) A f U ' " ( y TM) |
,.,y~r~ ( ~ " 1 ......... l for rn > 1 and a x ' ( y l ) @ ~_((yl) for m = 1. ?4t
These definitions associate to each block (m) - c o r r e s p o n d i n g to a l] m tuple of o u t p u t s ym _ the set of functions of these o u t p u t s T/(y'~), a space of differential (urn + 1 ) - f o r m s x ' " , a set of functions 6) _Yn ~1 "Y "+~ g a t h e r i n g , ,nTT~, all functions of zl to zm-1 a n d a m o d u l e to characterize the state affine s t r u c t u r e of each block. We can t h e n state: T h e o r e m 1.7 A nonlinear s y s t e m (1.1) cascade observable w.r.t, outputs h = ( y l , . . . y q ) in the sense of (1.32) is equivalent at xo to a s y s t e m I11 . . . t J q (E . . . . ... . ,) descmbed by (1.31) If " a n d o n l y If 9 y i E J~ , ", ( n l , . . . n q ) are cascade observability indices of (1.1) and there exist q Um-tuples of vector fields X m = ( X ] n, X m ] 1 .< r e < q ,. such. that, . .for l < r e < q :
9
9
.
.
l]m.
/
~
1. Lxj,,(y'~') ----0 if j • k and 1 otherwise, .for 1 < j , k < p yl ..,ym, 2. d i m ( f P " ~ ' " (E)) = n,,, - u m on On, ......... I
[ dix,,,~x'"(y ') A A~'-I (A "~-'~ ~x..,ex'(y j) A d~Jyj) = 0 3.
m-1 J dix, " ~x'" ( ym ) A A~:I(A v.,
" ~ - ~ i x. ~ X~ ( yJ ) A d ~ 'y j ) rn--1
nj--uj
.
~'"a~'"(y~) Adh,A A ( A i~,a~"(YJ) Ad~JY~)| k
1=1 q
j=l n , ) --~,:j
~ A(e~"y ~A A "
x~
j=l
This s t a t e m e n t follows previous results of [20], [4] or [6], a n d can be checked by the same kind of arguments: necessity is o b t a i n e d by verifying t h a t conditions I to 4 are indeed satisfied for a s y s t e m of the f o r m (1.31) w i t h X~ ~ = a a n d sufficiency is established by inductively defining new c o o r d i n a t e s OgF" under the form dzj A dzy-1 A ... A dzl = M j ( y j, z j - 1 , . . , z l ) i x J f t Xj (yY) A dZj_l A ... A d z 1 where M can be found on the basis of condition 3 along the same lines as in [6]. T h e p r o b l e m in such a characterization is t o find a p p r o p r i a t e vector fields X i. Let us sketch a constructive procedure giving such vector fields in the case of systems equivalent to (1.31) where each block takes the following
1. A Viewpoint on Observability and Observer Design for Nonlinear Systems
19
form: Zil
~-- A~I (u, z i _ l , Yi)+A~2 (u, _zi-1)zi2
Zi2 Zi3
~-~--
A ~ (u, z_~_~,yi) + A~2(u, z~_~, y~)z~2 + A~a(U, Z~_l)Z~3 Ai31(u,z__i_l , Yi) +A32(u, i i (u, _zi_ 1 , Y i ) Z i 3 Zi-- 1 , Y i ) Z i 2 ~-A33 +A~4(u, z _ i _ l ) Z i 4
Zini_ 1
Ai~-I,I(u, zi-1, Y i ) + A ni~ - l , 2 ( u , z i - 1 , y i ) z i 2 + i Ai.,:-1,3( u, _zi-1, Y i ) Z i 3 Jr- An.~_l,4(u, Zi-1)Zi4
i (~, z~_l)z~, +... + An.,:_l,n.~
z~n~
i Z = An,l(u,_~_l,yi) + A~2(u,Zi_l,yi)zi2+
yi
= Ciz~ = z~l E ~:t
9
A , , , 3 ( u , - i -Z1 ,
Y i ) zi3 -~ A ni ~ 4 ( u , z i - 1 ) z i 4
~- "" ~-
A~,~,
(u Zi_l)Zin,,
(1.33) where ( Z i l , . . . , z~,~,.)T = zi and z~_ 1 = (z~, z T , . . , zT_I) T for i > 2 a n d is e m p t y otherwise 9 Notice t h a t any s y s t e m equivalent to a form (1.31) where A~ (u, z i _ l , yi) = Ai(u, zi_l) - as characterized in [4] - is equivalent to a form where each block has this triangular s t r u c t u r e (1.33). Notice also that, as in the case of state-affine equivalent s y s t e m s where A(u, y) does not d e p e n d on y, e.g. considered in [20], one can c o m p u t e sets of c o n s t a n t control sequences I~ in the form { (uiH, " " " ~tilk)' " " " (~tivil' " . U ..,k } such that: { d L f ~ ( h l ) , k = 0 . . . r l } spans dO(hi) a n d inductively,
{dLf,~(hi) , k = O. ". r~}AAi~_~dO(hl ) spansdO(hi) A Al=l i-1 dO(hi) (where hi denotes the o u t p u t function for Yi and Lfq: (hi) is the vector of c o m p o nents LI, h ... Lf,,t (hi))9 On this basis, one can inductively c o m p u t e candidates for X 1 to X q on the s a m e p a t t e r n , given hereafter for X I : 9 C o m p u t e Y (uniquely) defined by:
gy(hl) L r L L } (hi)
=
0,
=
0 if j % T1, 1 otherwise;
LyLL~(hz)
=
0
and forj=l
forj=l,..rt,
top
(1.34) (1.35)
l=2,...q.
9 B y successive Lie Brackets, c o m p u t e Y,~....... 3 := [fv~,-,,... [f-~, Y ] . . . ] a n d Y~...... , := [f,,,, Y,~,_~ .... ~] for some c o n s t a n t vi's, a n d set: Lf,,, (hi) Z := Yv,,...Vl + - 9 Check: d L z ( h l ) =- 0; L z ( h l ) ~ 0 and finally set: X 1 .--
1
Lz(hl)
Z.
20
1. A Viewpoint on Observability and Observer Design for Nonlinear Systems
One can check by inspection that such a construction necessarily gives a candidate for X 1. The same construction can be used to find X 2 to X n and finally, verification of conditions of Theorem 1.7 reduces to differentiations and tests of linear dependencies. In this way, the particular structure (1.33) can be fully intrinsically characterized, as this is done for several cases in [6].
6
Conclusions
The purpose of this chapter was to draw some lines of recent advances in the problem of observer design for nonlinear systems and highlight several further directions of research. In particular, the problem of the input has been underlined for the observability properties of the systems, and several aspects of observer designs based on interconnection of sub-observers as well as state transformations have been discussed. In terms of the technique used for the design, obviously further methods can be thought of, for instance including optimization [25], sliding modes [27] etc.
Acknowledgement The author would like to thank Professors Hassan Hammouri and Guy Bornard for having awoken and fed his interest in nonlinear observers.
7
REFERENCES [1] G. Besan~on. Contributions d l'Etude et i~ l'Observation des Syst~mes Non Lin~aires avec Recours au Calcul Formel. PhD thesis, Institut National Polytechnique de Grenoble, 1996. Laboratoire d'Automatique de Grenoble. [2] G. Besan~on and H. Hammouri, "On uniform observation of nonuniformly observable systems," Systems ~4 Control Letters, vol. 33, no. 1, pp. 1-11, 1996.
[3]
G. Besanqon and G. Bornard. "A condition for cascade time-varying linearization," in IFA C Proc., Nonlinear Control Systems Design Symposium, Tahoe City, CA, USA, pp. 684-689, 1995.
[4] G. Besan~on, G. Bornard, and H. Hammouri. "Observer synthesis for a class of nonlinear control systems," Europ. Journal of Control, vol. 3, no. 1, pp. 176-193, 1996.
1. A Viewpoint on Observability and Observer Design for Nonlinear Systems
21
[5] G. Besanqon and G. Bornard. "State equivalence based observer design for nonlinear control systems," in Proc. IFAC World Congress, San Francisco, CA, USA, pp. 287-292, 1996. [6] G. Besan~on and G. Bornard. "On characterizing classes of observer forms for nonlinear systems," in Proc. ~th European Control Conf., Br~tssels, Belgium, 1997. [7] G. Besan~on and H. Hammouri. "On observer design for interconnected systems," Journal o.f Mathematical Systems, Estimation, Control, vol. 8, no. 3, 1998. [8] D. Bestle and M. Zeitz. "Canonical form observer design for nonlinear time-variable systems," Int. Journal of Control, vol. 38, no. 2, pp. 419431, 1983. [9] W. M. Boothby. An Introduction to Differentiable Manifolds and Riemannian Geometry. Academic Press, New York, 1975. [10] G. Bornard, N. Couenne and F. Celle. "Regularly persistent observer for bilinear systems," in Proc. of the Colloque International en Automatique Non Lin~aire, Nantes, June 1988. [11] G. Bornard, F. Celle-Couenne and G. Gilles. "Observability and observers," in Nonlinear Systems - T.1, Modeling and Estimation, pp. 173 216, Chapman & Hall, London, 1995. [12] K. Busawon. Sur les Observateurs pour des Syst~mes Non Lin~aires et le Principe de S~paration. PhD thesis, Universit~ Claude Bernard, Lyon I, 1996. [13] D. Dawson, Z. Qu and J. Carroll. "On the state observation and output feedback problems for nonlinear uncertain systems," Systems Control Letters, vol. 18, pp. 217-222, 1992. [14] J.P. Gauthier and G. Bornard. "Observability for any u(t) of a class of nonlinear systems," IEEE Trans. on Automatic Control, vol. 26, no. 4, pp. 922-926, 1981. [15] J.P. Gauthier and A. Kupka. "Observability and observers for nonlinear systems," Siam Journal on Control and Optimization, vol. 32, no. 4, pp. 975-994, 1994. [16] J.P. Gauthier, H. Hammouri and S. Othman. "A simple observer for nonlinear systems - applications to bioreactors," IEEE Trans. on Automatic Control, vol. 37, no. 6, pp. 875-880, 1992. [17] H. Hammouri and J. D. L. Morales. "Observer synthesis for stateaffine systems," in Proc. 29th IEEE Conf. on Decision and Control, Honolulu, Hawaii, pp. 784-785, 1990.
22
1. A Viewpoint on Observability and Observer Design for Nonlinear Systems
[18] H. Hammouri and F. Celle. "Some results about nonlinear systems equivalence for the observer synthesis," in New Trends in Systems Theory, pp. 332-339, Birkh~user, 1991. [19] H. Hammouri and J.P. Gauthier. "Bilinearization up to output injection," Systems ~ Control Letters, vol. 11, pp. 139-149, 1988. [20] H. Hammouri and M. Kinnaert. "A new formulation for time-varying linearization up to output injection," Systems ~ Control Letters, vol. 28, pp. 151-157, 1996. [21] S. Hara and K. Furuta. "Minimal order state observers for bilinear systems," Int. Journal of Control, vol. 24, no. 5, pp. 705-718, 1976. [22] R. Hermann and A. Krener. "Nonlinear controllability and observability," IEEE Trans. on Automatic Control, vol. 22, no. 5, pp. 728-740, 1977. [23] A. J. Krener and A. Isidori. "Linearization by output injection and nonlinear observers," Systems ~ Control Letters, vol. 3, pp. 47-52, 1983. [24] A. J. Krener and W. Respondek. "Nonlinear observers with linearizable error dynamics," Siam Journal on Control and Optimization, vol. 23, no. 2, pp. 197 216, 1985. [25] H. Michalska and D. Mayne. "Moving horizon observers," in IFAC Proc., Nonlinear Control Systems Design Symposium, Bordeaux, France, pp. 576 581, June 1992. [26] J. Rudolph and M. Zeitz. "A block triangular nonlinear observer normal form," Systems ~ Control Letters, vol. 23, pp. 1-8, 1994. [27] J. J. E. Slotine, J. Hedrick and E. Misawa. "On sliding observers for nonlinear systems," Journal of Dynamic Systems, Measurements, and Control, vol. 109, pp. 245 252, 1987. [28] J. Tu and J. Stein. "Model error compensation and robust observer design - part 2: Bearing temperature and preload estimation," in Proc. American Control Conference, Baltimore, Mawland, USA, pp. 33083312, June 1994. [29] B. Walcott and S. Zak. "State observation of nonlinear uncertain dynainical systems," IEEE Trans. on Automatic Control, vol. 32, no. 2, pp. 166-170, 1987.
M o d e l - B a s e d Observers for T i r e / R o a d C o n t a c t Friction Prediction Carlos Canudas de Wit 1, Roberto Horowitz 2 and P. Tsiotras 3 1Laboratoire d ' A u t o m a t i q u e de Grenoble, U M R CNRS 5528 E N S I E G - I N P G , ST. Martin d'H~res, France. 2Department of Mechanical Engineering, University of California Berkeley, CA 94720-1740, U.S.A. 3Georgia Institute of Techology, School of Aerospace Eng. Atlanta, Georgia 30332-0150, U.S.A.
1
Introduction
This contribution is devoted to the problem of tire-road friction estimation. The need for such type of studies, steers from the difficulty of direct sensing of tire forces, slip, slip angles and other external factors. Observer algorithms are, in this context, a low cost alternative for sensors. Tire forces information is relevant to problems like: optimization of Anti-look brake systems (ABS), traction system, diagnostic of the road friction conditions, etc. Literature for tire/road friction estimation is numerous. Bakker et al [1] and Burckhardt [4] describe two analytical models for t i r e / r o a d behavior t h a t are intensively used by researchers in the field. In these two models the coefficient of friction, #, or more precisely, the normalized friction force, i.e. F Friction force # - F~ Normal force is mainly determined based on the wheel slip s and some other p a r a m e t e r s like speed and normal load. Fig. 1 shows two curves, obtained from H a r n e d et al [9], t h a t represent typical # versus s behavior. It is current practice to n a m e the ratio between the friction and the normal forces, #, as being the "coefficient" of friction. Under constant normal force conditions, #, is a constant if and only if the Coulomb model is used to describe friction. Nevertheless, the Coulomb model is too simplistic to suitable represent forces between the rubber tire and the road, which are dominated by the elesto-plastic force/displacement characteristics. Therefore, to consiser it as a constant is a pure idealistic view. p should thus
24
2. Model-Based Observers for Tire/Road Contact Friction Prediction Relali~ship ol ~
andi
Relallonship of ~ and i !
a~pha,'t
,
~
.
.
.
o~
.........
~
o~
. . . .
.
~M~
.......
:4o MP~
:
L ~ e g~avel .......
i
......
;
.
.
.
.
.
~o
_I o~1 i
0.1
02
03
04
05
06
LonOIttdnal sl~
07
08
09
1
-- ol
ol2
0'3
o'4
o'.5 or6 Long#u~naL slW
ol7
018
ol9
FIGURE 1. a) Variations between coefficient of road adhesion # and longitudinal slip s for different road surface conditions (left). b) Variations between coefficient of road adhesion # and longitudinal slip s for different vehicle velocities (right). be viewed more as the ratio between friction and normal forces (i.e. the normalized force), which is indeed a (static or dynamic) function of the system state variables. The expression given by Bakker et al [1], and Paceijka and Sharp [14], also known as "magic formula" is derived heuristically from experimental d a t a to produce a good fit. It provides the tire/road coefficient of friction # as a function of the slip s. The expression in Burckhardt [4] is derived with a similar methodology. The final m a p expresses # as a function of s, the vehicle velocity, v and the normal load on the tire F,~. Kiencke [10] presents a procedure for real-time estimation of #. A simplification to the analytical model by Burckhardt [4] is introduced in such a way that the relation between # and s is linear in the parameters. Kiencke [10] uses a two stages identification algorithm. In the first stage, the value of # is estimated. This estimate of # is used in the second stage to obtain the parameters for the simplified # versus s curve. The paper by Gustafsson [8] derives an scheme to identify different classes of roads. He assumes t h a t by combining the slip and the initial slope of the # versus s curve it is possible to distinguish between different road surfaces. The author tests for asphalt, wet asphalt, snow and ice and identifies the actual value of the slope with a K a h n a n filter and a least square algorithm. Ray [16] estimates # based on a different approach. Instead of using the slip information to derive a characteristic curve, Ray [16] estimates the forces on the tires with an extended K a l m a n filter. Using a tire model introduced by Szostak et al [17], that expresses the tire forces as a function of #, the author tries this model for different values of #. A Bayesian approach is used to determine the value of # that is most likely to produce the forces estimated with the extended K a l m a n filter. The works of Kiencke [10], Gustafsson [8], and Ray [16] do not consider any velocity dependence in the derivation of #, as suggested by B u r c k h a r d t
2. Model-Based Observers for Tire/Road Contact Friction Prediction
25
[4] and Harned et al [9]. An a t t e m p t to consider the velocity dependence for ABS control is presented in Liu and Sun [13]. The authors assume the tire/road characteristics to be known. Due to the limitations in the available data, the authors are not able to compare their algorithm with other methods. There are other works related to the on line identification of the t i r e / r o a d friction, as for example Lee and Tomizuka [12], and Yi and Jeong [18]. However, in these papers only the instantaneous coefficient of friction is identified. The coefficient of t i r e / r o a d friction, or coefficient of road adhesion, # is mainly a function of the longitudinal slip, the velocity of the vehicle and the normal load. The estimators proposed in the literature depends very much on the type of used models, and verification of the hypothesis used for the model derivation. As shown by the figures above, the relation of the curves # - s , depends very much on system operating conditions, such as the vehicle velocity. It is clear t h a t p a r a m e t e r s describing a curve like the one in Fig .1-(a), will not be invariant, as shown in Fig .l-(b). It is thus interesting to introduce models described by parameters t h a t are more likely to be invariant and have physical significance. Theory never exactly matches reality, but some times closely resembles it. To achieve this goal, we propose in this paper to use a dynamical t i r e / r o a d friction model, together with a nonlinear observer specifically designed for this application. This paper is organized as follows: The next section reviews some of the existing tire/road friction models, and also introduces lumped and distributed dynamic representations. In Section 3 we set-up the observation problem, using the particular case of a one-wheel system with lumped contact friction. Inspired from previous works by Canudas-deWit and Lischinsky [6] on adaptive friction estimation and compensation, Section 4 presents a general framework for the design of nonlinear observers for the on-line estimation of the road conditions. In Section 5 we apply this design to the case study case set in Section 3. Finally, Section 6 presents simulation results.
2
Tire-road Friction Models
This section reviews some friction models t h a t can be used for the study of the on-line identification of the friction force (or coefficient, if we consider normalized force). We first present the some of the pseudo steady-state models proposed in the literature, then we discuss some alternative dynamic (lumped and a distributed) models. T h e sep up for this study is the simple case of an one-wheel model with tire-road contact friction, shown schematically in Fig. 2. In this s t u d y we
26
2. Model-Based Observers for Tire/Road Contact Friction Prediction Wheel with
Wheel with
lumped friction F
distributed friction F
or
p
F I G U R E 2. One-wheel system with: lumped friction (left), distributed friction (right) will thus consider a s y s t e m of the form m~
=
F
J&
=
-rF
(2.1) + u,- - cr~w ,
(2.2)
where: m - wheel mass, J
wheel inertia,
r - wheel radius, v
linear velocity,
w - angular velocity, u~ - b r a k i n g / d r i v i n g torque, F
t i r e / r o a d friction force.
Therefore, only longitudinal m o t i o n (longitudinal slip) will be considered. 2.1
Pseudo-Steady
State
Models
This t y p e of models are currently used in the literature. T h e y are defined as one-to-one ( m e m o r y less) maps between the friction F , a n d the longitudinal slip r a t e s, defined as: s=
.... r ~r e -d v
if if
v > rw, v # 0 v
breaking driving
(2.3)
2. Model-Based Observers for Tire/Road Contact Friction Prediction
27
The slip rate results from the reduction of the effective circumference of the tire (consequence of the tread deformation due to the elasticity of the tire rubber), which implies t h a t the ground velocity will not be equal to v = r0a. T h e slip rate is defined in the interval [0, 1]. W h e n s = 0 there is no sliding (pure rolling), whereas s = 1 indicates full sliding. In opposition to steady-state friction models, the pseudo s t e a d y - s t a t e (PSS) models aim at describing the shapes shown in Fig.1 via static m a p s F ( s ) , m a p p i n g s to F, and not as a steady-state relation between contact relative velocity and friction forces. T h e y are n a m e d pseudo steady-state because some of these models depend on the vehicle velocity v, i.e. F ( s , v). T h e models also depends on the operating conditions, although they are only valid under steady-state conditions. One of the most well known models of this type is Pacejka's model (see, Pacejka and Sharp [14] ), also known by the n a m e of "magic formula". This model has been shown to suitably m a t c h experimental data, obtained under particular conditions of constant linear and angular velocity. T h e Pacejka model has the form F ( s ) = e~ sin(e2 arctan(~3~ - ~4(~a8 - a r c t a n ( ~ a ~ ) ) ) ) , where the c~s are the p a r a m e t e r s characterizing this model. The p a r a m e t e r s can be identified by matching experimental data, as shown in Bakker et az [1]. The model proposed by Burckhardt [4] for the t i r e / r o a d friction characteristics is of the form F ( s , v) : (c1(1 - e - c ' ) - eas) e - c ~ v
(2.4)
where cl, 999 , c4 are constants. T h e normal load at the tire is kept constant in this model. Note also the velocity dependency of this model, seeking to m a t c h variations like the one shown in Fig. l-(b). Kiencke and Daiss [11] neglect the velocity dependent t e r m in Eq. (2.4) and a p p r o x i m a t e the curve by F(s) = Ks
8
cls 2 + c2s + 1 '
(2.5)
where Ks is the slope of the F ( s ) versus s curve when s = 0 and Cl and c2 are properly chosen parameters. Notice t h a t Eq. (2.5) is only dependent on the slip s. T h e value of Ks is assumed to be known. Kiencke and Daiss [11] choose a fixed value of a b o u t 30 ~ for it. Alternative, Burckhardt [3] proposes a simpler three p a r a m e t e r s model, F(~)
= ~1(1 - e - c . )
_ ~s
Since these models are highly nonlinear in the unknown parameters, they are not well adapted to be used for on-line identification. For this reason, simplified models like F(~)
= clVq
- ~2~
28
2. Model-Based Observers for Tire/Road Contact Friction Prediction
are used in connection with a linear recursive identification algorithms, has been proposed in the literature. A part from the nonlinearity in the unknown parameters, the m a j o r limitation of this models seems to steer from the fact t h a t the unknown p a r a m e t e r s are not really invariant, they may strongly depend on the tire characteristics (such as compound, tread type, tread depth, inflation pressure, temperature), on the road conditions (such as type of surface, texture, drainage, capacity, temperature, lubricant, i.e. water or snow), and on the vehicle operational conditions (velocity, load), see P a s t e r k a m p and Paceijka [15]. As an alternative to the pseudo static models t h a t depend instantaneously only on s (memory-less models), dynamic models based on the preliminary studies on dynamic friction models of Dahl [7], can be a d a p t e d to suitably describe the road-tire contact friction. The Dahl's models leads to a friction displacement relation t h a t bears much resemblance with stressstrain relations proposed in classical solid mechanics. A potential advantage of such models is their ability to describe some of the physical phenomena found in r o a d / t i r e friction (such as: hysteresis loops, pre-sliding displacement, etc), as well as their dependance on p a r a m eters t h a t m a y have physical meaning. Although the p a r a m e t e r s of such models, m a y also depend on some of the factors mentioned above, other p a r a m e t e r s m a y be more like to be invariant, or be more directly related with the phenomena to be observed, like for instance the change on the road characteristics (i.e. dry wet, etc.). Dynamic models can be formulated as a lumped or distributed models, as shown in Fig. 2. This distinction will be discussed next.
2.2
Lumped Dynamic
Models
A lumped friction model assumes punctual tire-road friction contact. An example of such a model can be derived from the LuGre model (see Canudas et al, [5]). This model differs from the one in [5] in the way t h a t the function g(v) is defined. Here we propose to use the t e r m e -Iv'/v.'lm/2 instead the t e r m e -(v'/~.')2 as in the LuGre model in order to better m a t c h the pseudostationary characteristic of this model (map s H F(s) ) with the shape of the Paceijka's model, as it will be shown later. T h e model of Canudas et al, [5] is written:
: F
=
o-o1 ,-I (o-oz +
(2.6) + o-yv,.) Fn
with, = f f c + (ffs - ffc)
(2.7)
2. Model-Based Observers for Tire/Road Contact Friction Prediction
29
where, a0 - rubber longitudinal lumped stiffness, a l - rubber longitudinal lumped damping, (r2 - viscous relative damping, # c - normalized Coulomb friction, # s - normalized Static friction,
# c _< # s , C [0, 1],
v s - Stribeck relative velocity, Fn - normal force, vr - relative velocity --- (rw - v), z - internal friction state. R e m a r k : This model, has the following i m p o r t a n t properties: (i) if Iz(0)l < # s / a o , thus iz(t)l < # s / n o ,
Vt >_ 0,
(ii) oc > # s >_ g(v~) >_ # c > 0, Vv~ (iii) the right hand side of (2.6) is Lipschitz (globally if v~ is assumed bounded, and locally if not). In particular P r o p e r t y (i) ensures that the internal friction states are bounded and that its upper bound is given by the static friction p a r a m eter (Property (ii). Property (iii), provides existence and uniqueness of a solution to (2.6).
2.3
Distributed
Dynamic
Models
Distributed models assume the existence of an area of contact (or patch) between the tire and the road, as shown in Fig. 2. This p a t c h represent the projection of the part of the tire that is in contact with the road. T h e contact patch is associated to the frame Op, with ( as the axis coordinate. The patch length is L. Distributed dynamical models, as well as their relation with the pseudostatic models, has been studied previously in works of Bliman et al [2]. T h e y propose second order rate independent model (similar to the Dahl ones), and have shown that, under constant v and w, there exist a choice of p a r a m e t e r s t h a t closely m a t c h a curve similar to the one characterizing the magic formula.
30
2. Model-Based Observers for Tire/Road Contact Friction Prediction
Similar results can be obtained by using a model based in the first-order LuGre friction model, i.e.
dhz
t) = F
v~
=
~0}v~{ 5z Lg(vr)
(2.8)
dF((, t ) d ( ,
(2.9)
with g(v~) defined as before and
d F = ( - ~ ~z + vh ~2 + o'2v,.) dF~ , where,
a o / L - rubber longitudinal distributed stiffness per length, d F - differential friction force, dF,~ - distributed normal force [F~/ L], v~ - relative velocity = (rw - v), ~z - differential internal friction state. Note t h a t in this formulation the differential internal friction s t a t e 5z((, t), depends on b o t h time t, and space (. Indeed, Eq. (2.8) describes a partial differential equation.
dhz (r dt
2.4
05z. = -z=(r uq
O~z + --~-((, t) = v~
Relation Between Distributed Dynamical Magic Formula
5z
cr~
Lg(v~) M o d e l a n d the
The linear motion of the differential dF in the patch frame Op is ( = rw, for positive w, and ( --- - r w , for negative ~z (the frame origin change location when the wheel velocity reverses). Hence ( = r]w I. We can thus rewrite (2.8) in the ( coordinates as
d~z dt ((,t)
-
d~z
_
d(
d~zd( d(
d~z
dt ( ( , t ) = - - ~ - I ~ 1
= vr
~o1~1 5 z + s s g n ( r w Lg(v~)
v) .
~olv~l 5z
(2.10)
Lg(vr)
(2.11)
Assuming t h a t v, and w are constant (hence also v~, and s), the above equation describes a linear space invariant system having the sign of the relative velocity as its input.
2. Model-Based Observers for Tire/Road Contact Friction Prediction
31
Considering a positive value for sgn(rw - v) over the space interval [~(t0), ~(tl)], or equivalent over [@, ~1], we have that the solution of the above equation is:
~ ,~,
5Z((1) = 5Z(r
Lg(vT) (1 -
_[_ -
e
-~(r162 ~'~"~)
(y0
Introducing this solution together with Eq. (2.11) in Eq. (2.9), and integrating with 5z(@) = @ = 0, we have that F(s), is given as: For the driving case:
F(s,w) = Fng(s) [l -
(1
- c&s)'g(S) ~ ( e - ~ - l)] +
(2.12)
with ~(s) = # c + ( . s - ~ c ) e - j ~ / ~ ' j ~ / ~
for some constant w, and s E [0, 1]. For the breaking case:
F(s,v)= F~g(s)[1-(1-chs) g(s)crOs( e - ~ -
1)] +
(2.13)
with g(~) = ~ c + ( ~ s - ~ c ) e - ' ~ / ~ ' l ' "
for some constant v, and s E [0, 1]. Figure 3 shows the plot of F(s) with the parameters shown in the table 2.1. Parameter CY0 (r 1 CY2
Value 40 4.9487 0.0018
Unit [N/m l [N. s/m]
IN-s/m]
#s
o.5 o.9
[-]
Vs
12.5
[m/s]
#c
H
TABLE 2.1. Data used for the plot shown in Fig. 3 and Fig. 4 Uncertainty in the knowledge of the function introducing the parameter O, as
g(v~), can
be modeled by
g(vT) = ~(v~) 0 ' where ~(Vr) is some nominal known value for g(vr). Computation of the function F(s, 0), from Eq. (2.13), as a function of 0, gives the curves shown
32
2. Model-Based Observers for Tire/Road Contact Friction Prediction Static
view of the distributed
LuGre friction model
i
O.E
0.7 o 0.E
i
0.5
E ~ 0.,1
.z
vO,3 IJ
~ 0.2
0,1 0'.1
012
013
01.4
015 0'.6 S [Slip rate]
0'.7
0'.8
0'.9
FIGURE 3. Static view of the distributed LuGre model (breaking case, with v = 20m/s = 72Kin~h). This curve shows the normalized friction # = F ( s ) / F , , , as a function of the slip rate s. in Fig. 4. These curves matches reasonable well the experimental d a t a shown in Fig. 1-(a), for different coefficient of road adhesion. Hence, the p a r a m e t e r 0, suitable describes the changes in the road characteristics. Note that the pseudo-static representation, Eqs. (2.12) and (2.13), does not depends on the patch length L. Hence, the p a r a m e t e r s obtained by feeding this model to experimental data, can also be used in the simpler lumped model. This model will be used in the sequel for the observation problem to be defined next.
3
Problem
Formulation
We consider the one-wheel model with the lumped t i r e / r o a d friction model, i.e. mi~
=
Fn(croz + crib) + Fncy2v,
(2.14)
J&
=
-rF,~(C~oz + ~:~,) - cr,,w + uT
(2.15)
o "oiV L z
(2.16)
with,
g(v ) =
+
-
c)e
,
2. Model-Based Observers for T i r e / R o a d Contact Friction Prediction
33
Static view of the distributed LuGre fdction model
0.7,
0.6
==
E o
9~-~~
i t/theta = 0.8
~o, z 0.5
1/theta = 0.6
= 0.~ E
l/theta = 0.4
0.1
0.1
0~.2
01.3
0~.4
0~.5 01.6 s [Slip rate]
0'.7
0.8
0'.9
F I G U R E 4. Static view of the distributed LuGre model, under different values for 1/0. Breaking case, with v = 20rn/s = 72Krn/h. This curve shows the normalized friction # = F(s)/Fn, as a function of the slip rate s.
w h e r e we have n e g l e c t e d t h e t e r m c~2 in t h e e q u a t i o n (2.15), a n d i n t r o d u c e d the p a r a m e t e r 0 to c a p t u r e v a r i a t i o n a n d u n c e r t a i n t i e s in t h e f u n c t i o n g(vr). T h e o b s e r v a t i o n p r o b l e m c a n be now f o r m u l a t e d as follows. Problem formulation: Assume that the lumped friction parameters w i t h 0 -- 1, has b e e n identified off-line, a n d a s s u m e t h a t t h e v a r i a b l e w, a n d v a r e m e a s u r a b l e from s o m e sensors ( t h e n e e d for t h e m e a s u r e of v m a y b e r e l a x e d later). T h e p r o b l e m is t o d e s i g n a n o n - l i n e o b s e r v e r for 0, t h a t allows t h e controller t o m o n i t o r t h e e v e n t u a l c h a n g e s in t h e r o a d conditions.
4
General Observer Design
C o n s i d e r t h e following s y s t e m :
:~ =
A x + B[O~(y,u,x)] + Ru + E y
(2.17)
0 = 0
(2.1s)
y
(2.19)
~-
CTz
w i t h y, 0, ~ ( y , u, x) c R,x ~ R n, a n d u ~ R "~. W e a s s u m e t h a t s y s t e m s t a t e s a r e b o u n d e d , a n d t h a t t h e following holds:
2. Model-Based Observers for Tire/Road Contact l~riction Prediction
34
A1) (A, C) is an observable pair, A2) One of the following properties holds for ~o(y, u, x): There exist a known function oo > Po >_ P(Y, u) >_ O, such that:
WXl,X2,
(i) [~(y,u, x J - ~ ( y , u , x2)l <_p(y,u)llxl-x2[I, (ii) I~o(y,u,x)[ < p(y,u)llxll, Vx, A3) The map r ~-~ ~ of the system
x = ~] =
[A-KCT]~c+Br cT'2
(2.20) (2.21)
is strictly passive, i.e. V Q > 0, 3 P = p T > 0, and K, such that
P[A - K C v] + [A - KCT]T P
=
-Q
(2.22)
PB
--
C.
(2.23)
A4) The trajectories of the system (y(t), u(t), x(t)), satisfy: lim ~(y(t), u(t), x(t)) # 0
t ---*O0
Under this hypothesis, we propose the following observer structure: x
=
A~ + B 0~(v, ~, S:) + R~ + E y + K ( y - ~)) + m,~
(2.24)
0
=
u2
(2.25)
~]
=
cT$c
(2.26)
where ul, and u2, are design variables, which will be defined subsequently. Introducing the error variables: =
x- k
(2.27)
0- 0 y - ~) = c T g ,
(2.28) (2.29)
[ A - K c V ] 2 + Z [ O ~ ( y , u , x ) - 0~(y,u,k)] - Bul
(2.30)
-"2 cT~:,
(2.31) (2.32)
t) = = The error equation becomes
=
~1
=
where, e~(y, u, x) - ~ ( y , ~, 2) = ~ ( y , u, 2) + e [~(y, ~, x) - ~(v, ~, 2)]
2. Model-Based Observers for Tire/Road Contact Friction Prediction
35
Now, defining the L y a p u n o v function
w = ~Tp~ + lg2 a n d using properties A1, a n d A3, we have =
- - ~ T 0 ~ + 20 [9~(y, u, ~) -- 7 - % ]
(2.33)
+2~)0 [~(y, u, x) - ~(y, u, 2)] - y/21
(2.34)
Defining the a d a p t a t i o n law ~2 as ~'2 = 3'P(Y, u, 5:)~
(2.35)
we o b t a i n
<_
- x T Q yc + 21~1101 [~(Y, ~, x) - ~(y, ~, ~)1 - Z~x.
(2.36)
If A2 - (i) holds, then we have,
,r
<
_ ~ T Q ~ + 21~llOlp(u, u)ll:~ll - Y/21
(2.37)
_<
-qll~ll 2 + 211cTIIlOIp(U,u)ll~ll 2 -- ZY~'a
(2.38)
_<
--ll:~ll2(q-- 211cTIIIOIPo) - flv~ ,
(2.39)
where
q
=
/~rninQ.
Since (2.22) holds for any Q, the m i n i m u m eigenvalue of Q can be selected such t h a t the t e r m within the parenthesis of the last inequality is positive, i.e. q = 211cTIII01PO + q0 with any q0 > O, a n d Omax ~_ ]0]. Note t h a t a value of Oma~ can be o b t a i n e d from the knowledge on the road characteristics, as discussed in previous sections. In this case we can simply set Pl = O, to get x~ ~ - q o l l ~ l l 2 . In the second case, when only A2 - (ii) holds, we have
~r
<_ _ ~ T Q ~ c + 2[~[[Olp(y,u)(llx[ I _ [[~l[)
_
y/J1
(2.40)
<- - JcTQ ~c - l Y l [- 20maxp(y, u)([lXllmax -l]21])+sgn(9)t/1] (2.41) which suggests t h a t ~1 should be defined to have a high-gain c o m p o n e n t , i.e. ~'1 = 2 0 m o x K y , u)(llxllmax -- I[:~ll)sgn(~),
36
2. Model-Based Observers for Tire/Road Contact Friction Prediction
where Omax, and ]lxllmax, are respectively constant upper bounds of the p a r a m e t e r 0 and the state norm Ilxll. With this choice of ul we have as before t h a t 9 <_ -qlL~ll 2 . Thus, in b o t h of the cases considered by assumption A2 ~, and 0 are bounded, and ~ -~ 0. Finally, from the error equation (2.30), we have t h a t
u, x)} : 0, which together with assumption A4 leads us to conclude t h a t lim 0 = 8 .
W e have proved the following theorem: Theorem
2.1 Consider the .following system
0 y
=
A x + B IOn(y, u, x)] + R u + E y
(2.42)
= =
0
(2.43)
CTx
(2.44)
under the assumptions A 1 - A4, with y , 0 , ~ ( y , u , x ) u E R m. Then the following observer
with
u, ~)
x
=
A~ + B ~ ( y ,
+ R u + E y + K ( y - 9) + B~,I
0
=
7~(Y,u,S:)~
(2.46)
9
=
C r:?,
(2.47)
{o
"~ =
E R, x 6 R n, and
2 o m ~ p ( y , u)(llxll . . . . - I I ~ l l ) s g n ( 9 )
if if
A2-(i)holds A2-(ii)holds
(2.45)
(2.48)
ensures (under verification (~f A4), that lim ~) = 8.
t---~oO
5
Application to the One-Wheel Model
We consider the one-wheel model with lumped friction as described by the equations (2.14)-(2.16). As formulated previously, we assume t h a t b o t h v
2. Model-Based Observers for T i r e / R o a d Contact Friction Prediction
37
a n d w a r e m e a s u r a b l e variables. To set o u r s y s t e m in t h e s a m e f r a m e w o r k t h a t t h e s t r u c t u r e (2.17)-(2.19), we i n t r o d u c e t h e n e w v a r i a b l e
X = J"~ + rF~0"1z, from w h i c h we get: =
- - -0-O x
+ (ja0
O'1
_ a ~ ) ~ + u~
(2.49)
0"1
(2.50) y
=
(2.51)
"~(:z - rFn0"1z) = w .
Defining x, u a n d y r e s p e c t i v e l y as
Z
~
y=w~
U~
we c a n r e w r i t e t h e a b o v e s y s t e m as =
0~1
0
x -4-
1
0~(y, u, x) +
y A-
0
w h e r e ~ ( y , u, x), is defined as Z.
W i t h this r e p r e s e n t a t i o n we shall now verify c o n d i t i o n u n d e r w h i c h t h e ass u m p t i o n s A1 - A3 hold. T h e last c o n d i t i o n A 4 d e p e n d s on t h e o p e r a t i o n a l c o n d i t i o n s , in p a r t i c u l a r on t h e a p p l i e d t o r q u e u~. Condition i.e
A1 ( l i n e a r o b s e r v a b i l i t y ) . o1
A =
0
0
W i t h A, a n d C d e f i n e d as above,
C~
- ~ ,~l J
we have t h a t c o n d i t i o n A1 h o l d s for a n y values of t h e s y s t e m p a r a m e t e r s .
rank[C, ATC] =rank
[1
_ ~, , o , J
r F ,0 ,oo
]
=
2
J
T h i s r a n k c o n d i t i o n c l e a r l y shows t h a t t h e e x i s t e n c e a n o n - z e r o n o r m a l force F,~ is n e c e s s a r y to b u i l d t h e friction observer. Condition aolry--vl
- ~ z ,
A2 ( g l o b a l L i p s c h i t z
condition).
W i t h ~ ( y , u, x) =
we have t h a t a01ry - vl
Iv(y,u, xl)-v(y,u, xl)l < 9 - ~ - J) izl-z~l <_ p(y,u)lzl-z~l _< p(y,u)ll~l-x~ll
38
2. Model-Based Observers for Tire/Road Contact Friction Prediction
where p(y, u) =
Cro#c[ry-
v].
C o n d i t i o n A3 ( P a s s i v i t y ) . Finding a vector K , so t h a t the m a p r ~ of the system description (2.20)-(2.21), is strictly passive, is equivalent to searching for a vector K = [kl, k2] T, such t h a t the I / O - m a p G(s), defined as
G(s) = C T [Is - A + K C T] -1 B ,
(2.52)
is strictly positive real (SPR), i.e. R e { G ( j w ) } > 0, Vw 6 [0, co] C o m p u t a t i o n of G(s) with the corresponding values for A, B, C gives the map s + fl G(8) =
(2.53)
82 -{- O~18 + C~2
with fl
--
oo kl + (rl J
Oz1
~-
fl - k2 r F n a l J
a2
=
-ilk2
rFn(rl
-~
+klk2
rFnCrl
j2
A sufficient condition to this function be S P R is that k2 < O. T h e n a simple choice for K is thus ]~1
=
0
k2
=
-k,
for some k > 0. From the Kalman-Yakubovich-Popov lemma, we thus ensure with this choice of K that there exist P satisfying the L y a p u n o v equation with P B = C. C o n d i t i o n A4 ( P e r s i s t e n c e o f e x c i t a t i o n ) . To ensure p a r a m e t e r convergence we need to guarantee t h a t lim
t ----*oo
~(y(t), u(t), x(t))
=
lim
olry(t)
-
v(t)l z(t) r o
t --* oo
This implies that the relative velocity should not tend to zero in order for the estimated p a r a m e t e r to converge. This in turn implies t h a t the internal friction state z(t) will not asymptotically converge to zero. Finally, we have,
2. Model-Based Observers for Tire/Road Contact Friction Prediction
39
2.2 Consider the one-wheel model with lumped dynamic .friction (2.~9)- (2.51), then the .following observer:
Theorem
=
_0-0~ + (j0-0 _ 0-~)w + u~ O"1
=
0
=
~) =
(2.54)
0-1
0-01r
~(~-
v) -
0-01r g(vr) -
vl
rFn0-1~),
_
-
(2.55)
(2.56)
(2.57)
with positive nonzero k, and % ensures that all the estimated states are bounded, and that: lim ~ ----X
(2.58)
lim 5 = z.
(2.59)
t ---* ~:) t ----*oO
If in addition, the relative contact velocity does not vanishes, then we also have that lira 0 = 0 . t----*OO
5.1
Simulation Results
Simulations have been performed with the one-wheel system and the l u m p e d LuGre model. The friction parameters used in the simulations are the ones given in Table 1, with the following additional values for the wheel: r -25[cm], m = 5[Kg], J = 0 . 7 5 . m * r 2 = 0.2344[Kgm2], F,~ = 14[Kgm2/s2]. Fig. 5, shows simulation results. Fig. 5-(a) shows the time-profile of the contact friction force resulting form the application of the time torque profile u~(t) shown in Fig. 5-(e). T h e simulation has first an acceleration phase, and then a breaking phase. From Fig. 5-(a), we can see t h a t a b o u t 2 seconds are needed for the friction torque to reach its m a x i m u m value. The observation error of the X, and z is shown in Fig. 5-(d). According to the theorem these two variables should converge to their true values regardless the profile evolution of the system states. This is verified by this curve showing the exponential convergence of the II(~(t), 5)11 to zero. Since the ultimate goal of this work is to be able to on-line estimate this variation, the simulation was done under variations of the p a r a m e t e r 0, representing the road variation conditions (see Fig. 4). Fig. 5-(b) shows in bold lines the value of 0, which evolves within fourth different conditions: the first quarter of the simulation corresponds to dry asphalt conditions. The second quarter corresponds to a sudden change from dry to wet. During the third quarter, there is a smooth variation from wet to snow. T h e last
40
2. Model-Based Observers for Tire/Road Contact Friction Prediction Contact friction force
Estimation of theta 4.~
0.=
0.,
3.~
o~ 0.,
WET 2.~
o ~'-o.
12
"~ -OA
l
-o,E
O~
-o.e -1
DRY
0 ,
2
4
6
8 tO 12 Time [secondsJ
14
16
18
20
-O.5
2
4
6
Applied torque
'
1'0
1'2 2
Time [seconds]
8
10
12
Time [seconds I
14
16
18
20
1'8
2o
Observer error norm
1'4 ' '
1'6 '
1'8 '
0
~
~
;
1'0
,'2
Time [seconds]
~'4
l's
FIGURE 5. a) Contact torque friction F(t) (up left), b)Estimated parameter 0(t), and evolution of 0 (up right), c) Applied wheel torque uT(t) (low left), d)Observe error norm of ()~(t), ~) (low right). quarter is keep constant at the snow conditions. In dotted lines we can see the evolution of the estimate t~(t). As we can observe, a good parameter tracking is obtained, as long as the relative contact velocity is different from zero. During the small time-period when this velocity is small or zero, the adaptation law yields a constant 0(t).
6
Conclusions
We have presented a m e t h o d to estimate on-line the changes in road condition. To achieve this goal we have introduced dynamical friction models that, one hand provide a more accurate description of the contact friction, and one the other hand, allow us to characterize road condition variations via a single parameter. It has been shown that the distributed parameter version of these m o d e l also capture stationary shape profiles between normalized friction and slip rate that are similar to the ones obtained from experimental data (i.e. magic formula).
2. Model-Based Observers for Tire/Road Contact Friction Prediction
41
We have introduced a model-base observer that ensure asymptotic tracking of road condition, under mild conditions implying a non-vanishing evolution of the slip rate. This condition are quite natural in this context (they imply that the vehicle should operate away to the ideal pure rolling condition). Mathematically, this condition correspond to the persistently excitation condition, which is well known in the adaptive control literature. In the context of nonlinear observers, this condition appear as being the characterization of "good " inputs, which are required to recover state observability. The observer presented here has been derived in a general framework allowing to extend our study to the case where the vehicle velocity is not measurable. In particular, assumption A2 - (ii) will allows for this extension, if it can be shown that the assumption A3, also holds. This study and the introduction of other factors like: wheel vertical deformation, and suspension dynamics, are currently under study.
Acknowledgements The LuGre version of the dynamic friction model presented here, was derived during the first author visit at the Department of Aeronautics at the Georgia Institute of Technology ( C N R S / N S F collaboration project). A more complete report on this topic is in preparation. The first author would like also to thanks M. Sorin and P.A. Bliman for the interesting discussion on distributed friction models. 7
REFERENCES [1] E. Bakker, L. Nyborg and H. Pacejka. Tyre Modelling for Use in Vehicle Dynamic Studies. Society of Automotive Engineers Paper 4P 870421, 1987. [2] P. A. Bliman, T. Bonald and M. Sorine. Hysteresis Operators and tire Friction Models: Application to vehicle dynamic Simulator. Prof. of ICIAM. 95, Hamburg, Germany, 3-7 July, 1995. [3] M. Burckhardt. ABS und ASR, Sicherheitsrelevantes, RadschlupfRegel System, Lecture Scripture. University of Braunschweig, Germany, 1987. [4] M. Burckhardt. Fahrnverktechnik: Radschlupfregelsysteme. Verlag, Germany, 1993.
Vogel-
[5] C. Canudas de Wit, H. Olsson, K. J..~strOm and P. Lischinsky. A New Model for Control of Systems with Friction, IEEE TAC, Vol. 40, No. 3, pp.419-425, March 1995.
42
2. Model-Based Observers for Tire/Road Contact Friction Prediction
[6] C. Canudas de Wit and P. Lischinsky. Adaptive friction compensation with partially known dynamic friction model, International Journal o.f Adaptive Control and Signal Processing, Vol. 11, pp.65-85, 1997. [7] P. R. Dahl. Solid Frictioin Damping of Mechanical Vibrations. AIAA Journal, 14, No. 12, pp.1675-1682, 1997. [8] F. Gustafsson. Slip-based Tire-road Friction Estimation. Automatica, 33(6):1087-1099, 1997. [9] J. Harned, L. Johnston and G. Scharpf. Measurement of Tire Brake Force Characteristics as Related to Wheel Slip (Antilock) Control System Design. SAE Transactions, 78(690214):909-25, 1969. [10] U. Kiencke. Realtime Estimation of Adhesion Characteristic Between Tyres and Road. In Proceedings o.f the IFA C World Congress, volume 1, 1993. [11] U. Kiencke and A. Daiss. Estimation of Tyre Friction for Enhaced ABS-Systems. In Proceedings of the AVEG'9~, 1994. [12] H. Lee and M. Tomizuka. Adaptive Traction Control. PATH Technical Report UCB-ITS-PRR-95-32, Institute of Transportation Studies, University of California at Berkeley, 1995. [13] Y. Liu and J. Sun. Target Slip Tracking Using Gain-Scheduling for Antilock Braking Systems. In The American Control Conference, pages 1178-82, Seattle, Washington, 1995. [14] H. B. Pacejka and R. S. Sharp. Shear Force Developments by Psneumatic tires in Steady-state conditions: A review of Modeling Aspects.. Vehicle Systems Dynamics, Vol. 20, pp.121-176, 1991. [15] W. R. Pasterkamp and H. B. Pacejka. The Tire as a Sensor to Estimate Friction. Vehicle Systems Dynamics, Vol. 29,(1997) pp.409-422, 1997. [16] L. R. Ray. Nonlinear Tire Force Estimation and Road Friction Identification: Simulation and Experiments. Automatica, 33(10):1819-1833, 1997. [17] H. T. Szostak,R. W. Allen and T. J. Rosenthal. Analytical Modeling of Driver Response in Crash Avoidance Manuevering. Volume II: An Interactive Tire Model for Driver/Vehicle Simulation. Report no. DOT HS 807-271, U.S. Department of Transportation, 1988. [18] K. Yi and T. Jeong. Observer Based Estimation of Tire-road Friction for Collision Warning Algorithm Adaptation. JSME International Journal, 41(1):116-124, 1998.
Observer Design for Nonlinear Oscillatory Systems Dag Kristiansen and Olav Egeland D e p a r t m e n t of Engineering Cybernetics Norwegian University of Science and Technology Trondheim, Norway
1
Introduction
Numerous vibration phenomena which are theoretically interesting as well as practically i m p o r t a n t can only be understood on the basis of nonlinear vibrations. For instance, the wide field of self-excited, p a r a m e t r i c and auto-parametric vibration demands nonlinear t r e a t m e n t from the very beginning. The sources of the nonlinearities m a y be either geometric, inertiM, material, damping or a combination of these things. Nonlinearities bring a whole range of p h e n o m e n a that are not found in linear systems. In single-degree-of-freedom systems these p h e n o m e n a include multiple solutions, jumps, limit cycles, natural frequency shift, subharmonic and superharmonic resonances, period-multiplying bifurcations, and chaotic motions [12]. Large excitation levels are usually needed to produce periodmultiplying bifurcations and chaotic motions in single-degree-of-freedom systems. In addition to the above mentioned phenomena, the response of nonlinear multi-degree-of-freedom systems can exhibit combinations resonances and modal interactions. T h e latter m a y provide a coupling or an energy exchange between the system's modes and arises if there exists a special relationship between two or more natural frequencies of the linear modes and an excitation frequency. This means that the long-time responses of the system can contain significant contributions in m a n y modes of vibration. The presence of significant responses in more t h a n one m o d e increases the number of modal equations t h a t must be analyzed, and this generally serves to complicate the dynamics of the system. More importantly, modal interactions can lead to dangerously large responses in modes t h a t are predicted by linear analysis to have insignificant response amplitudes. T h e extent of the interaction and its conditions depend on the linear natural eigenfrequencies wi and the nonlinearities of the system. More precisely, autoparametric resonances in systems with n linear natural frequencies (wl,. 99 , w,~) and n corresponding modes (the eigenfrequencies are assumed to real and
44
3. Observer Design for Nonlinear Oscillatory Systems
nonzero) occur whenever two or more eigenfrequencies are c o m m e n s u r a b l e or n e a r l y c o m m e n s u r a b l e (see e.g. [12, 1]). If a harmonic external excitation of frequency f~ acts on a multi-degree-of-freedom system, then in addition to all primary and secondary resonances ( r f ~ ~ s w i , where r and s being integers) of a single-degree-of-freedom system, there might exist other resonant combinations of the frequencies in the form r f ~ ~ S l W l + 9 9 9 + S n W n , n where r and si are integers such that r + ~ i = 1 Isi[ = N, where N is the order of the nonlinearity plus one and n is the number of degrees of freedom. This means for multidegree-of-freedom systems with cubic nonlinearities, to the first approximation, combination resonances may occur
if a
I•
•
a
1•
or a
I•
If
quadratic nonlinearities are added, additional combination resonances m a y occur if ~t ~ [+win + wk[. Thus, a high-frequency excitation may produce large amplitude responses in low-frequency modes that are involved in the combination resonance and vice versa. Interestingly, the concept of modal interactions can also be utilized in control design, see e.g. [14, 13, 3]. In this chapter we will focus on designing full-state nonlinear observers for systems where i n t e r n a l r e s o n a n c e is present. We will assume that we do not have any measurements of the velocities and also that we cannot measure each position separately. Direct applications include e.g. cylinder gyroscopes [4]. As an analysis-tool, we shall use the concept of contraction theory [10]. A short review of this concept is given in Section 2.
2
Contraction Theory
In connection with the observer design, c o n t r a c t i o n t h e o r y will play an important role in the analysis. Here we will give a short review of the theory known as contraction theory which was proposed by [10]. The results are based on ideas from fluid mechanics and tools from differential geometry. The basic idea is to view the system differential equations as an n-dimensional "fluid-flow" described by Euler coordinates. By calculating the squared distance between two trajectories in the "flow-field" one ends up with a concept called contraction region. The interested reader is referred to [10] and the references therein for more on this subject. It is also worth mentioning that a thoroughly mathematical treatment of similar ideas can be found in [2]. Given the nonlinear, non-autonomous system • = f (x, t)
(3.1)
where x C ~n and f :~n • I1~+ ~ R n is assumed to be sufficiently smooth. This equation can be written differentially as 5/r
0 f (x, t) 6x 7xx
(3.2)
3. Observer Design for Nonlinear Oscillatory Systems
45
where 5x is a virtual displacement. The squared distance between two neighboring trajectories can be defined as 5xT6x, which means that the rate of change is given by s dt
= 25x 5
=
(3.3)
Let Area• (x, t) denote the largest eigenvalue of 89( o f + 0,, of T~/ , then
II xll < II xolleJ
....
(3.4)
If )~max (X, t) is uniformly strictly negative, (3.4) shows that [lSx[[ converges exponentially to zero. This implies by path integration that the length of any finite path converges exponentially to zero. Now consider the differential coordinate transformation
6z = o (x, t) 5x
(3.5)
where @ (x, t) is a square matrix. Then a generalization of the squared length is
5zTSz ----5 x T M (x, t) 5x
(3.6)
where M (x, t) = O T (X, t) O (X, t) represents a symmetric and continuously differentiable metric. If M (x, t) is uniformly positive definite, exponential convergence of 5z to zero implies exponential convergence of 5x to zero. We also have that d S z = FSz, where F = ((~ + O ~- 1 5 -O ~ ] , and we can state the following definition and theorem: D e f i n i t i o n 3.1 ([10]) Given the system equations • = f ( x , t ) , a region of the state space is called a contraction region with respect to a uniformly positive de.finite metric M (x, t) = O T (x, t) O (x, t) /f F is uniformly negative definite in that region. Regions where F is negative semi-definite are called semi-contracting, and regions where F is skew-symmetric are called indifferent. T h e o r e m 3.1 ([10]) Given the system equations • = f (x, t), any trajectory which starts in a ball of constant radius with respect to the metric M (x, t), centered at a given trajectory and contained at all times in a contraction region with respect to M (x, t), remains in that ball and converges exponentially to this trajectory. Furthermore global exponential convergence to the given trajectory is guaranteed of the whole state space is a contraction region with respect to the metric M (x, t).
46
3. Observer Design for Nonlinear Oscillatory Systems
R e m a r k 3.1 ([7]) Note that V = 0 T O-~x can be written in terms of Christoffel symbol of the first kind, i.e., [11]: 1 {OMm
rh k =
OMlh Ox k
\-a-7
OMhk ) Ox t
+ - -
(3.7)
Since Fhlk = Fklh [11], we have that Fmkahb k = Fklhakb h = Fmkbha k
(3.8)
where a k is the k-th component of the vector a and bh is the h-th component of the vector b. This means that.for autonomous 0 (x), we can analyze the i.e., dynamics ~ = O• in place of F = O + Ox J
O0f'~O-1,
d (SzTSz) = 25z TS~ dt
(3.9)
since 62 = 5 (O•
=
5x~ + O
0• 25zT 5i = 25xT OT (\ 0OX
5x = -~-x•
+ O~xx~X
f ' ~/I 6X =--~ d (SzrSz) q- o O'~X
(3.10)
(3.11)
A last result which will be used in the observer design is the following [10]: Consider a smooth virtual dynamics of the form
XQ 5Zl ) dt
5z2
(Fll =
F21
0 F22
)(SZl)
(3.12)
5z2
and assume that F21 is bounded. Exponential convergence of 5zl can be concluded for uniformly negative definite F n . Also, if F22 is uniformly negative definite, this implies exponential convergence of the whole system to a single trajectory since F215zl represents an exponentially decaying disturbance in the second equation. We can think of the dynamics of 5zl as the plant, and the dynamics of 5z2 as the observer. By designing the observer such that the system trajectory is contained in the "flow-field" of the observer, this means that the observer is exponential convergent if F u and F22 are uniformly negative definite, and F2a is bounded.
3 System Equations We will assume that our system is given as n nonlinearly coupled oscillators with constant mass M =diag{mi} > 0 and linear viscous damping C =diag{# d > 0, i.e. [12],
3. Observer Design for Nonlinear Oscillatory Systems
M~
=
Cl --
v
y
~qi
=
OV
-Cv
-~q + F
47
(3.13) (3.14) (3.15)
i
where F is an external forcing and V = V (q) will decide w h a t t y p e s of nonlinearities which are present in the s y s t e m (e.g. quadratic, cubic or both). More precisely, V can be w r i t t e n as V = V1 + V2 where V1 is due to the linear spring constants a n d is a s s u m e d to be positive, and V2 reflects the nonlinear coupling terms. Note t h a t our m e a s u r e m e n t y, given by (3.15), m a k e s this p r o b l e m in some sense different from e.g. robotics where one usually can m e a s u r e each position separately. We will a s s u m e t h a t t h e s y s t e m p a r a m e t e r s (mass, d a m p i n g etc.) are known.
3.1
Analysis
C o n t r a c t i o n analysis of mechanical s y s t e m s in H a m i l t o n i a n f o r m were inv e s t i g a t e d in [9, 8, 6], while s y s t e m s in L a g r a n g i a n form were considered in [7]. Here we will give an alternative analysis, which is a direct consequence of energy considerations. We will a s s u m e t h a t 1. V can be w r i t t e n as V = q T p (q) q where P is positive definite. 2. ~
can be w r i t t e n as ~ q = K ( q ) q where K is a square m a t r i x .
Now (3.13) can be w r i t t e n differentially as ( F = 0) Mdv = -Cdq-
OVdt
(3.16)
0q
Using -~q = K (q) q, (3.16) can be w r i t t e n as Mdv = -Cdq
- K (q)
qdt
(3.17)
Since P > 0, there exists a m a t r i x W (q) such t h a t W T (q) W (q) = P (q)
(3.18)
Define
0
x/2W (q)
q
a n d introduce q~ = q
(3.20)
48
3. Observer Design for Nonlinear Oscillatory Systems then dz
~Z
0
~
o de ) v/2W(q) ) ( dq
(3.21)
)
(3.22)
0
( v/-~ 0
Also from (3.19) (3.23) Then, using (3.9) dt =
( 5qTv/-M
V~5r
T (q))
v~o(~(qq/q)Sq
_-- --~qTC5 q - 5qT K (q) 5r +25r
T (q) 0 (W (q) q) 5q 0q
(3.24)
Note that OV m
0q
z
0 (qTWT (q) W (q) q) 0 ( w (q) q ) T w (q) q = K (q) q =2 cOq Oq (3.25)
i.e., KT (q) = 2~vvT (q) 0 (W0q(q) q)
(3.26)
such that d--~
$zTSz
= --SqTCSq
(3.27)
which means that the "flow-field" is semi-contracting. Bounded 5q and ~r and by assuming that K (q) is bounded, leads to bounded 5v (using MSv = - C S q - K (q) 50). Assuming bounded ~ means that 5~ is bounded since MS~ = - C 5 v - ~ 5q. This means that 5q and 5v c o n verges asymptotically to zero.
3. Observer Design for Nonlinear Oscillatory Systems
49
R e m a r k 3.2 As in [7], the above analysis can be regarded as a generaliza-
tion of the energy conservation since d ( 2 6 q T M 6 q + 5r
(q) W (q)
--SqTCSq
(3.28)
d ( l dqTMdq + dCTwT (q) w (q)
-dqTCdq
(3.29)
Multiplying with 7-iv. 1 . d ( 1 v T M v + q T w T (q) W (q) q )
h7 4
=
--vTCv
(3.30)
--vTCv
(3.31)
Observer Design
Since we do not have any measurements of the velocities, we will take advantage of the following result due to [5]: Given the system = f (x, t)
(3.32)
with measurement y = h (x)
(3.33)
and the following general observer X
:?
=
g (~, y, t)
(3.34)
h (~)
(3.35)
where g, h are assumed to be smooth functions. We can state the following result: P r o p o s i t i o n 3.1 ([5]) Given a smooth coordinate transformation of the observer dynamics ~ = N (R, ~), where .for each ~, the mapping ~ ~-~ ~ is in-
vertible, and given the n-dimensional system equations and m-dimensional measurements ~r =
f(x,t)
(3.36)
y
h(x)
(3.37)
=
50
3. Observer Design for Nonlinear Oscillatory Systems
then the observer equations x
=
g(~,y,t)
:9
=
h (R)
(3.38) (3.39)
transform to (3.40)
:~ = g (:~, y, t) + 7a y- (~' - 5')
i.f _
0R (:~ (.~, y), y) g (:~ (R, y) y, t) OR O~ (:~ (R, y ) , y ) O-~Oh(:~ (~, y)) g (Yc (~, y ) , y, t) +~yy
(3.41)
is integrated instead of (3. 38) and (3. 39). T h e proof can be found in [5]. We now propose the following observer for (3.13)-(3.15): Mv
=
s
q
-C9-
~
0~
+F
(3.42)
=
Introduce M ~ = M ~ ' -
"
(3.43)
~), t h e n ( F = O)
M ~ = - C r 1 6 2 OV
(~1) H~
(3.44)
0~
where H =
V1 "
'" "
"Yl ) " and
7n
" " "
~n
M v = M~5 +
" %
= -C9
0 V (s
00
H (~, - v)
(3.45)
We can now view (3.13), (3.14), (3.43) and (3.45) as a hierarchical combination as in (3.12). Since H is bounded, this means t h a t under the assumption t h a t K ((t) and ~O ~ V are bounded, 5(7t and 5~r converge a s y m p t o t i c a l l y to zero.
3. Observer Design for Nonlinear Oscillatory Systems
51
R e m a r k 3.3 Note that due to our measurement (3.15), i.f the observer equation (3.43) is changed to q = 9 - H ( q - q), this implies that (using the relation K T (0) = 2 w T (q) 0(W~l)0))
dt
= ( 5~Tv/-M _ & ~ T H T v / ~
4555 w
(
)
v e,
= - 5 ~ T (C + H) 6~ + ~ ) T H T (C + H) 5~ _~T
( H T K (~1) + 2WT ((?t) 0 (W0~l((?t)q) H'~] 5r
where~=~,r
~z =
o)(o)
0
v ~ W (0) ~q;
,/~W(el)
, ~
=
0
o
(3.46)
'
.
~.0
Generally, there seems to be no conclusion about the contraction behaviour o.f this observer design. However .from (3.46) we see that when the gains in the observer (7i) are in some sense small, this observer "behaves" in the same way as (3.42) and (3.43).
5
Simulations
5.1
E x a m p l e 1: 2 - D O F O s c i l l a t o r y S y s t e m w i t h C u b i c Nonlinearities
Nonlinear oscillations in multi-degree-of-freedom systems with cubic nonlinearities can be found in many physical systems such as the vibration of strings, beams, membranes, and plates for which stretching is significant, the motion of spherical, centripetal, and double pendulums, and the motion of masses connected with nonlinear springs [12]. For a 2-dof mechanical system with cubic nonlinearities, V is given by kl 2 + --~-q2 k 2 2 + alq 4 + ct2q31q2 + a3qlq2 V = --~-ql 2 2 + o~4qlq23 + 0~5q4
(3.47)
where ki > 0 are the linear spring constants and ai are constants. Note that V can be written as V
=
( ql
q2 )
~" + ~
=
(ql
q2 ) P ( q ) (
2+g
89( 2ql + ql )q2
leg
2
3q2
I, 2ql ~- 4(/2] _~a + a5q~ + 89
ql q2 (3.48)
52
3. Observer Design for Nonlinear Oscillatory Systems
Also 0V
_
// kl -t- 4alq12 + 2a3q 2
=
~ a2ql2 + 3a4q2 2 K(q) q
0q
30~2q12 ~-o~4q 2
)(
k2 + 2c~3q 2 + 4a5q 2
ql )
q2 (3.49)
T h e following p a r a m e t e r s were used in the simulations: rnl = rn2 = 1, O~1 = 1, OZ2 ~---0.9, ~3 : 0.8, OL4 = 0.6, O~5 ~---0.5, #1 = #2 : 0.001, k I ---~ 1,
is o i ivo o n 0. nceo >0 ~I~3
d
~ 4
> -
0
(3.50)
c~ 4
> -
0
(3.51)
0~20~4 OL10~5 Jr- - ~ -}- T
> --
0
(3.52)
2 0~3015
2
T h e initial conditions of the plant were: qz (0) = q2 (0) = vl (0) = v2 (0) = 0, while the initial conditions of the observer were ql (0) = 1, q2 (0) = 1, Vl (0) :
0.5, Y2 (0) :
--0.4. T h e r e s u l t s u s i n g ")/1 = "/2 :
-1
is s h o w n in
Figures 1-5
0
-9.5
10
20
30 t~me [s]
40
1
50
60
F I G U R E 1. ql (t) [solid line] and 01 (t) [dotted line].
5.2 Example 2: Cylinder Gyroscope T h e nonlinear d y n a m i c s of a cylinder gyroscope was m o d e l l e d a n d a n a l y z e d by [4]. T h e m o d e l included geometric nonlinearities, a n d it was shown t h a t V is given by
3. Observer Design for Nonlinear Oscillatory Systems
'I
53
t
10
"-0
2o
3o time [s]
4o
so
6o
FIGURE 2. vl (t) [solid line] and ~1 (t) [dotted line].
1
o.
I I I'~ Ib j~ C
-0.2
h
-0.4 ~3.6
10
FIGURE
20
ti
4o
Is]
~o
~o
3. q2 (t) [solid line] and 02 (t) [dotted line].
1
2
1
2
1
2
/ ~]gl -}- alql + ~a4q2 + ~a5q3 [ V = ( ql q2 q3 ) I lasql + lalOq3 1 1 2 1 2 \ 7a7ql + gagq2 ] la - - - la ]a _2 - - 1 a ~2 8r
T ~
I0r
~ 7 ( / 1 - I " - ~ 9~/2
)(ql)
1 1 2 1 2 ~k2 + a2q22 + ~a4ql + ~a6q3 0 q2 1 2 1 2 0 lk3 + a3q 2 + ~asql + ~a6q2 q3 where ki are positive constants and aj are constants depending on the linear axial mode shapes of the gyroscope. Straightforward calculations show
54
3. Observer Design for Nonlinear Oscillatory Systems
U 0 ili" =0.51
i t,me [sl
F I G U R E 4. v2 (t) [solid line] and ~2 (t) [dotted line].
-0.
-1
10
20
30 t,me [s]
40
SO
60
F I G U R E 5. y (t) [solid line] and ~)(t) [dotted line]. that
OV Oq
kl ~- 4alq 2 + 2a4q~ + 2a5q~ + 2asq2 asql § a l o q a a7q 2 + a9q 2 + aloq2 0 k2 + 4a2q2 + 2a4q~ + 2a6q2 + 2a9qlq3 0 3arq2+agq2+az~ k3 + 4aaq2 + 2asq~ + 2asq 2
) ( ql qa
K (q) q T h e following p a r a m e t e r s w e r e u s e d in t h e s i m u l a t i o n s : m l = m2 = m a --- 1, a l = 1, a2 = 1, a3 = 1, a4 = 0.3, a5 = 0.4, as = 0.3, a7 = 0.5, as = 0.5,
3. Observer Design for Nonlinear Oscillatory S y s t e m s a9
=
0.7, alo = 0.3, #1 = #2 = #3 = 0.001,
a n d F -be q; of ~2 in
0 0
k1 =
1, k2 = 9,
k3
55 -----
25,
. Note that with these data, V can be shown to
p o s i t i v e for q r 0. T h e initial c o n d i t i o n s of t h e plant were: q l ( 0 ) ---(0) = qa (0) = vl (0) = v2 (0) = v3 (0) ---- 0, w h i l e t h e initial c o n d i t i o n s t h e o b s e r v e r w e r e 01 (0) = 1, 02 (0) = 1, 03 (0) = - 0 . 2 , ~1 (0) = - 0 . 5 , (0) = - 0 . 4 , ~3 (0) = - 0 . 1 . T h e results u s i n g 71 = 3'2 = 73 = - 1 is s h o w n Figures 6-12.
1 O.E OE 0.4 0.,~ 0
41,2 -0.4 ~).6 ~.8 -1
10
20
30 time [s]
40
50
60
F I G U R E 6. ql (t) [solid line] and ql (t) [dotted line].
-0
-1
-1 .S
10
20
30 time Is]
40
50
60
F I G U R E 7. vl (t) [solid line] and 51 (t) [dotted line].
56
3. Observer Design for Nonlinear Oscillatory Systems
o,
o
i',,,
0
10
2o
~
4o
5O
60
Is]
ti
FIGURE S. q2 (t) [solid line] and 02 (t) [dotted line].
1A 1 0..= C -9.5 -1
iI
-1.5 -2 -25 -3
10
20
3O
4O
5O
6O
t~rne ($]
FIGURE 9. v2 (t) [solid line] and ~2 (t) [dotted line].
6
Conclusions
We have proposed an observer for nonlinear oscillatory s y s t e m s in Lan grangian form with a single m e a s u r e m e n t given by y = 7:i=1 qi. T h e analysis was mainly based on contraction theory which can be found in the papers by Lohmiller and Slotine [5]- [10]. It was s h o w n that the p r o p o s e d observer was asymptotically convergent. T h e observer was simulated first on a 2-dof s y s t e m w i t h cubic nonlinearities, and then on a m o d e l of a cylinder gyroscope. T h e simulations s h o w e d agreement with the theoretical analysis.
3. Observer Design for Nonlinear Oscillatory Systems
57
J,
0
10
20
3O time [s]
4O
5O
6O
FIGURE 10. q3 (t) [solid line] and c)3 (t) [dotted line]. 1.S
~0
-1
-1.5
10
20
30 time [s]
40
50
60
FIGURE 11. va (t) [solid line] and ~a (t) [dotted line].
7
REFERENCES [1] R. Evan-Iwanowski Resonance Oscillations in Mechanical Systems, Elsevier, New York, 1976. [2] P. Hartman. Ordinary Differential Equations, Birkhauser Verlag, Boston, 1982. [3] A. Khajepour, F. Golnaxaghi and K. A. Morris. "Modal Coupling Controller Design Using a Normal Form Method, Part 1 & 2," Journal o.f Sound and Vibration, vol. 205, pp. 657-688, 1997. [4] D. Kristiansen and O. Egeland. "Nonlinear Oscillations in Coriolis Based Gyroscopes," Accepted for publication in Nonlinear Dynamics. [5] W. Lohmiller and J. J.-E. Slotine "On Metric Observers for Nonlinear Systems," Proceedings IEEE International Conference on Control
58
3. Observer Design for Nonlinear Oscillatory Systems
O.
-o.:
-1
10
20
tirn3eO[~]
40
50
60
FIGURE 12. y (t) [solid line] and y (t) [dotted line]. Applications, Dearborn, MI, pp. 320-326, 1996.
[6] W. Lohmiller and J.-J.E. Slotine. "On Metric Controllers and Observers for Nonlinear Systems," Proceedings 35th IEEE Conference on Decision and Control, Kobe, Japan, pp. 1477-1482, 1996. [7] W. Lohmiller and J.-J.E. Slotine. "Applications of Contraction Analysis," Proceedings 36th IEEE Cor~ference on Decision and Control, San Diego, CA, pp. 1044-1050, 1997. [8] W. Lohmiller and J.-J.E. Slotine. "Applications of Contraction Analysis," Proceedings IEEE International Conference on Control Applications, Hartford, CT, pp. 699-704, 1997. [9] W. Lohmiller and J.-J.E. Slotine. "Simple Observers for Hamiltonian Systems," American Control Conference, Albuquerque, NM, 1997. [10] W. Lohmiller and J.-J.E. Slotine. "On Contraction Analysis for Nonlinear Systems," Automatica, vol. 34, pp. 683-696, 1998. [11] D. Lovelock and H. Run& Tensors, Differential Forms, and Variational Principles, Dover Publications, New York, 1989. [121 A. H. Nayfeh and D. T. Mook. Nonlinear Oscillations, Wiley, New York, 1979. [13] S. S. Oueini, A. H. Nayfeh and J. R. Pratt "A Nonlinear Vibration Absorber for Flexible Structures," Nonlinear Dynamics, vol. 15, pp. 259-282, 1998. [14] K. L. Tuer, M. F. Golnaraghi and D. Wang. "Towards a Generalized Regulation Scheme for Oscillatory Systems via Coupling Effects," IEEE Transactions on Automatic Control, vol. 40, pp. 522-530, 1995.
Transformation to State Atfine S y s t e m and Observer D e s i g n A. Glumineau and V. L6pez-M. Institut de Recherche en Cybern6tique de NANTES, IRCyN, UMR 6597 1 rue de la Noe, B.P. 92101, 44321 Nantes cedex 3. F R A N C E
1
Introduction
The observer design problem is completely solved for linear time invariant systems, whereas in the nonlinear case, there is no general theory. In order to tackle this problem, some methods have been employed: Lyapunov-like technique, linearizations, numerical differentiation, and geometric and algebraic methods (cf. [2, 10, 16, 18, 27, 6, 9, 21, 28, 31]). In order to combine the advantages and improve the shortcomings of two different approaches, structural and numerical differentiation have been sucessfully dealed with input time derivatives [25] and input and/or output time derivatives [21]. Table 1 summarizes the existing literature and shows some observer applications. Table 1 L i n e a r i z a t i o n by i n p u t - o u t p u t injection
System =
A( + ~o(y, u)
Approach Geometric: [16, 22, 31] Algebraic: [9, 10, 19]
Applications Motor: Shunt DC, Series De: [5, 24], Flexible joint: [23].
Geometric: = A~ + ~o(y,u,i~,... , u (~))
= A~ + ~(y,--. ,y(S),u,--- ,u (~))
[2s, 15] Algebraic: [26, 25]
[21]
Biological systems: [28], Numerical differentiation: [6].
In order to extend the class of linearizable systems, some results about the transformation of nonlinear systems into state affine systems have been obtained. High-gain observers are useful for state alZfine systems as shown in [3, 12, 30] and the references therein. These observers are based on optimal Kalman's observer and used in physical processes, for instance chemical reactors, distilling columns and mechanical systems [8, 30, I].
60
4. Transformation to State Affine System and Observer Design
T h e following table summarizes the main contributions on the equivalence between a nonlinear system and a bilinear or state afflne system, as well as some observer design applications. T a b l e 1. Authors Construct.
System
= A(u)~ + ~(u, y) = A(u, y)~ + ~(u, y)
[11]
~o
[141 [1]
Yes No
[20]
Yes
Applications
Synch. Generator [17] Inverse Pendulum [1] Chemical reactor [8] Distilling columns [30]
In the following our new results [20] are introduced. One of the contributions of [20] is the definition of a first algorithm to compute the transformed system functions, from the I / O differential equation. The chapter is organized as follows. Section 2 introduces some definitions and notation. Section 3 we state the problem of state affine transformation of nonlinear systems, and gives the aim of our approach we introduce by an example. We define an algorithm t h a t permits to give a NSC in order to solve this problem. Section 4 obtains the synthesis observer for the s t a t e affine system founded in Section 3. This is achieved with a well defined coordinates transformation and a Kalman-like observer. Some conclusions are given in Section 5.
2
Definitions and N o t a t i o n
Consider the nonlinear system:
{~ --
= y
f(x,u)
=
(4.1)
with x ~ M where M is an open and dense subset of ~n, u C ~ m and y E ~. T h e entries of f(., .) and hi. ) are meromorphic functions of their arguments. Let us define the state affine system, considered here
{ A(y(t), (t))Zcz +
(4.2)
where z(t) 9 ..~n y(t) 9 '.~,u(t) 9 ~m. W h e n one measures y(t), one can define ~ :--- (y, u) as a new input a n d as recalled in [13] if it is regularly persistent [3], thus the system
~o { "~--- A(v~). ~. + qo(~)- S - I c T ( c ~ -- y) = - O S - AT(~)S - SA(~)) + c T c
(4.3)
4. Transformation to State Affine System and Observer Design
61
is a Kalman-like observer for ~--~a" Where z(t) C ~ n S(t) E ~ + is a symmetric positive definite matrix and 0 > 0. The norm of the estimation error converges locally exponentially to the origin. From now on, ~ is supposed to be generically observable [25] and will be called observable.
3
Problem
Statement
The goal is to find a state coordinates transformation z ----O(x), such that system ~ (4.1) is locally equivalent to system ~'~.~ (4.2, in order to design the observer ff-~-o (4.3)9 The approach consists in checking t h a t the I / O differential equation associated to the system ~ has the same form than the ~ one. The uniqueness of this equation for an observable system is shown in [29].
3.1
The Input-Output Differential Equation for State Affine Systems ~-~
The I//O differential equation for }-~ verifies
P~
:= y(n) = F n ( A ~ , . . . , A,~_~)+ + F n - 1 (A1, " 9" , A n - l , t/91)+ + A 1 F n - 2 ( A 2 , . . . , A n - l , ~2) + " " +A1A2"'" A n - 2 F 1 ( A n - l , ~gn--1)+ A1A2"" A~-IFo(~,~),
(4.4)
where F~_j (0 <_ j < n), is the sum of all monomials in~ .
.
.
.
u
kl)
'
.
.
.
....
(4.5)
such that n l q l q- 9 ". q- npqp + kll 1 q- . 9 q- kmlm = n - j. F n - j is a function involving all monomials of "degree" ( n - j ) . For instance, Fn verifies ]11(A1,"" , An-l)
f I >(A1, -.. , An_2) + Fn:=Y
f(3)(A1,""", An-3) + 531(-) f~n~--22~l(A1,A2) + ~(n-2)l(')
[l~ nl] (n-x) + (~(n--1)1(')
(4.6)
62
4. Transformation to State Affine System and Observer Design
where Y := [y(n-1)... 9] and ~/31(') (2 < /3 <~ n -- 1), involves all the functions not depending on I / O time derivatives of degree /3. Whereas F n - j verifies
Fn_j
..__-
~(n--j) ~j
^(n--j--l), YJJ(n--j--2) " " " ~gj] 9
[u
]lj(Aj," " ,An-,) f.(2) lA .,.. ~(3)r4 J3j k~3~
An-3) + 53j(.)
[log Aj]('~-J) + 5(~_j)j (.) for l _ < j < n - l a n d F 0 : = ~ n . R e m a r k 4.1 The cascade form of the f i l functions in (4.6), is useful to
compute Ai functions. E x a m p l e 4.1 Let the 3-D nonlinear system )-~a,
Zl ----Al(u)z2 + ~ l ( y , u ) z2 = As(y, u)z3 + ~2(Y, u) ~3 = ~3(y, u) y=-z
(4.7)
1
Its I / O differential equation (4.4) verifies pa
:=
+
y(3):=F3(A1,A2)+F2(A1,A2,~I) A1FI(A2, ~2) + AIA2Fo(7~3)
(4.8)
where, as defined in (4.6) and (3.1),
F3 f(n)
:=
Y . f(A); F2 := ~2) _ [~bl~l]. f(A)
:=
[log(n2n2), loi-'A 1 - l o g ' n I - log 2~1A2] T
F1
:~-- ~2 - ~21og"A2
Fo
:=
(4.9)
~3
where Y := [y(2) $]. One of the contributions of [20] is the definition of a first algorithm to compute the A~ and ~ functions from the I-O differential equation.
3.2
State A j f i n e T r a n s f o r m a t i o n A l g o r i t h m
This algorithm proceeds in two steps. First, one derives all the Ai functions from Fn in (4.4). Then, one finds n - 1 first order partial differential equations and gives a NSC for the existence of a solution. Secondly, substituting
4. Transformation to State Affine System and Observer Design
63
them in (4.4), one solves the following equation y(n) -
F~ =
F~-I(A1,"
" " ,A~-1,~1)
+AIFn-2(A2, ' " , A,~-I, ~2) +'" + AI'" An-2FI(An-1, P,-1) +A1 "-" An-lFo(qon).
(4.10)
S.A.T. Algorithm. S t e p 1. Prom I / O differential equation of ~ ( 4 . 1 ) set P0 := Y("). For k = 1 to n - 1, ck := 1 with c~-l := 0 let:
02 P~ ~ 02 P~ wk .-- Oy(k)Oy(n_k ) dy + OU~k)Oy(,~_k)duj j=l
(4.11)
Forl
0 or dwk A d u r
0 then the problem has no solution.
9 IfdwkAdy=0anddwkAdu=0 then let the Ai functions be any solution of 02 Pa m wk = Oy(k)Oy(n_k ) dy + j=IE
02 Pa
Olt~k)Oy(n_k) duj
(4.12)
For k = n - 1 9 If dw,~-i ~ O, then the problem has no solution. The algorithm stops. 9 If dw,~_l = O, then let A1 be any solution of
1~
OA1
-duj, Cdn--1= ~11 j = l -OUj
(4.13)
where P a ( A ~ , . . - , A,~_I, ~ 1 , " " ~ , ) is the formal I / O equation (4.4) computed for the system ~ .
S t e p 2. Substitute all the A~ functions in (4.4). Forr=l tonlet /Dr := Pr-1 - F n - r + l
(4.14)
~i and let define K r := A1 "A2 . . - A r with An := 1, and the differential form aJ r as
:=
1 L[ |
OP~
dy +
'~ ,~OP~ (nj=l ouj
)duj
]
.
(4.15)
64
4. Transformation to State Affine System and Observer Design 9 If d ~
A dy ~ 0, d ~
A du ~ 0 then the p r o b l e m has no solution.
9 If d ~
A dy = 0, d ~ r A du = 0 t h e n ~r is a solution of
Ar I [~dy ( 0_.~Ad
-J- E j ~ I ~u~,duj - A'A~" m
0_~Ad u . h _ JJ ] ~- wr for 1 < r < n - 1 , AI-.-A,~-I~n:=Pn forr=n.
oy Y "j- E j = I auj
4.1 : The nonlinear system ~ is locally equivalent to the system by a state coordinates transformation z = r if and only if:
Theorem
~
dwk A dy -- 0, dwk A du = 0
(4.16)
for 1 < k K n - 2 dLdn_ 1 = 0
(4.17)
a~r A dy = 0, d~r A du = 0
(4.18)
where wk (1 < k < n - 1), a n d - ~ (1 < r < n) are defined by (3.11) and (4.15) respectively. Thus, if ~ is locally equivalent to ~ a , then the state coordinates transformation z = ~ ( x ) is c o m p u t e d from ~ a : Zl
=
y = h(x)
1
(h - ~ l ( y , u ) )
-
z3
=
(4.19)
A1 9A2 h (~) - A1~2 - ~bl - log"A1 (h - ~1) A1 9 A2
zk
=
y(k-1) _ Pk-1 k-1 I-L=I A~
(4.20)
where k-1
k-1
Pk=-~k H A, +-fik_l + z k H Ai i=1 i=1 for l < k K n , An : = 0 a n d Pl : = Wl. For the details of the proof, see [20]
(4.21)
4. Transformation to State Affine System and Observer Design
4
65
Synthesis Observer for State Affine Systems
The observer ~-~o of ~ ,
can be the realized solving
f; = - O S - A T ( z g ) S - S A O ) ) + c T c
(4.22)
The time varying solution is a definite positive matrice, and 0 E ~+. In order to avoid the time varying computation, [4] propose a transformation, = ~ z where n--1
fi := diag(1-I A,),
with Ao := 1.
(4.23)
i=0
Applying it to system ~ a , one gets = A--~+ r ( o , () y = C(
(4.24)
= (1
(.1)
where V(0,() := Oqo(J) + f i f e - l ( , ~ := flA(0)~t-1 i.e.
1 0 --. 0 0 /
O 0 0 =
1
0
.
0
AI~
.
ooo 0
0 ;f~(o)
=
oi 0
0
n--1 Hr=l Ar~n
0 i
~-
1 = Diag (log 1-I A t - 1 ), 1 < i "( n.
where A0 := 1. Assume that NF(~,()II _< KH(II s with II(lls :~ ( T S ( 9 Thus it is Lipchitzian with respect to (, uniformly w.r.t. 0 with Lipschitz constant K. Then consider the system = ~r
+ r(~,
r
-
s:o'c~(c~
- y)
(4.25)
where So~ is the algebraic stationary solution of 0 ---- -OSoo - "ATsoo - Soo"A + c T c
(4.26)
for 0 large enough. Then, for inputs 0 uniformly bounded by some 0 > 0 : (4.25) is an observer for (4.24), i.e., for 0 large enough H~(t) -- ~(t)l I ~ K ( O ) e x p ( - 0 t / 3 ) l l ~
0- r
(4.27)
66
4. Transformation to State Affine System and Observer Design
For the proof and the details cf. [7]. Thus from (4.23) this observer in the z coordinates have the following form = ~-~-1~
~-lh~
_
(4.28)
substituting (4.25) in (4.28) we finally have
"~= A ( d ) } + ~(~) - f}-I s ~ ' c T ( c ~ - y)
(4.29)
The transformation f} and its inverse is always well defined since the observability assumption.
4.1
Physical Example
In order to illustrate the feasibility of S.A.T. Algorithm, Theorem 4.1 and the observer synthesis, we apply now the algorithm to a physical example. The SISO system is a inverse pendulum, as considered in [1]. The dynamics of the system are :Cl
=
X2 CON X
y
---- X l ,
~_ l \(- a l s i n xl z'22 + .~co~:~1 /(1--acos 2 xl)
,_-,u ~] ,n
(4.30)
where xl denotes the angular displacement of the pendulum shaft from vertical position, 1 is its length, m the mass of the plumb bob, g the force of gravity and a the ratio ~ with M the mass of the bearing trolley, u is the force applied to the car. Then, the system I / O differential equation is given by
(
gm sin p "~
y(2) = - a c o s y \ I m s i n y . ~]2 + u /m(1 -- a cos 2 y)
cosy]
(4.31)
A1Fo(~)
(4.32)
y loi-A1; F1 := 9~1 - l o g A l ~ l p2
(4.33)
a
and for ~-~a, one gets P a - - y(2) = F 2 ( A 1 ) + F I ( A 1 , ~1) +
where F2 F0
:= :=
Applying the S.A.T Algorithm gives AI(y) =
1 and (1--a cos2 y)89
P2 au cos y - g m sin y ~ 2 : = ~ 1 1 ---- lrn(1 acos 2 y)2• " -
-
(4.34)
4. T r a n s f o r m a t i o n to State Affine System a n d Observer Design
67
0.~
................ '
0.1
t
~o -0.1
-0.2
1
2
3
4
s
6
t
3.~ 3
^
z2
....
,
,
, :
1 :
,
:
i
:
i
i
:
i
9
i
9
i
i
f, O.E 0 -~X5
1
2
3
4
5
6
I
FIGURE 1. R e a l a n d e s t i m a t e d s t a t e v e r s u s t i m e (s).
The system (4.30) is then locally equivalent to: = y =- C z
0
0
z +
(0)
~2(Y, u)
(4.35)
= Zl
a n d f r o m (4.20) the state c o o r d i n a t e s t r a n s f o r m a t i o n : Zl = h ( x ) = x L ; z2 = x2(1 - a c o s ~ x l ) ~ .
Thus the observer (4.29) has the following form
= A(y)~ + ~ ( u , y ) - f t - ' S j o l c T ( ~ , - z,)
(4.36)
where Soo is t h e a l g e b r a i c s t a t i o n a r y s o l u t i o n of (4.25). S o l v i n g for Soo o n e
gets $11 = 1/0, $21 = - 1 / 0 2 , $22 = 2/03. T h e n SjolC T = (20 02) T a n d f~-'SjolC T = (20, 02/Al(y) )T.
4.2
Simulation Results
We present the simulation results for a trajectory tracking Yr := cl sin(c2t) where cl = .3, c2 = 1, a n d l = 0 . 3 6 m , t t M = 2 . 4 k g , , m = 0 , 2 3 k g , 0 = 50
68
4
Transformation to State Affine System and Observer Design 0.4
i
0.3
i
H
'
....... i ...........
i-
.
i
i ..................
:
/
/ -o.1 V -o.2
~.......... ~ ....... i . . . . . . . . .
-03~
i
.... i
3
4
5
i
'
!
i. . . . . . . . . . . . . .
i ......................
i
i. . . . . . . . . . . . . . . . .
i
:
. . . . .
1
.........
9
9 ! ..........
........
~
.....
2
i ..........
6 !
. . . . .
~01
:
o ~0'0
. . . . . .
~
.
.
.
.
.
.
.
.
. . . . . . . . . .
...... 1
2
:.
.
.
.
.
.....
9
i .......
.
.
i ....... ; . 3
4
5
6
FIGURE 2. Real and e s t i m a t e d state versus t i m e (s). and~ Zl(0) = z 2 ( 0 ) : = 0, ~1(0) = 0.2, ~2(0) = 3. In Fig. 1, we apply a tracking control with the real state and compare them with the estimated one. This error is practically neglectible. In Fig. 2, we measure only the output and apply the tracking control computed with the estimated states. As we have a pendulum set in our laboratory, next step of this work will be to check this observer in real conditions.
5
Conclusions
A NSC for the transformation to the state affine systems of MISO nonlinear systems has been obtained. The main result is stated in terms of the I / O differential equation and some one-forms obtained in a straightforward way and easy to check. With the help of a regular transformation, one avoids the time varying computation of the observer gain matrice an then a Kalmanlike observer ~-'~o (4.3) for the transformed system ~-~ (4.2) can be directly applied.
4. Transformation to State Atone System and Observer Design
6
69
REFERENCES [1] G. Besan~on and G. Bornard. State equivalence based observer synthesis for nonlinear control systems. Proc. IFA C 13th Triennial World Congress, (San Francisco, USA, Vol. E, 287-292, 1996. [2] J. Birk and M. Zeitz. Extended Luenberger observer for nonlinear multivariable systems, Int. Y. Control, 47, 1823-1836, 1988. [3] G. Bornard, N. Couenne and F. Celle. Regularly persistent observers for bilinear systems Proc. in 29 I.C.N.S., New trends in nonlinear system theory, (Vol. 122 Springer Verlag) June 1988. [4] K. Busawon, M. Farza and H. Hammouri. A simple observer for a class of nonlinear systems, Personal Communication. [5] J. N. Chiasson. 'Nonlinear differential-geometric techniques for control of a series DC motor', IEEE Trans. Contr. Syst. Technology, 2, 35-42, 1994. [6] S. Diop, J. W. Grizzle, P. E. Moraal and A. Stefanopoulou. Interpolation and numerical differentiation for observer design, Proc. ACC 94, Evanston, Illinois, 1329-1333, 1994. [7] J. P. Gauthier, H. Hammouri and S. Othman. A simple observer for nonlinear systems applications to bioreactors. IEEE TAC, 37(6), 885880, 1992. [8] D. Guillaume, P. Rouchon and J. Rudolph. Two simple observers for a class of polymerization reactors, ~th EGG '97, Bruxelles, 1997. [9] A. Glumineau, C. H. Moog and F. Plestan. New algebro-geometric conditions for the linearization by input-output injection, IEEE Trans. Autom. Control, 41,598-603, 1996.
[10] H. Hammouri and J. P. Gauthier. Bilinearization up to output injection, Syst. Contr. Letters, 11, 139-149, 1988. [11] H. Hammouri and J. P. Gauthier. Global time varying linearization up to output injection, SIAM J. Control Optim., 30 1992, 1295-1310, 1992. [12] H. Hammouri and M. de Le6n. Observer synthesis for state-affine systems, 29 th. CDC, Honolulu, Hawai. Dec. 5-7, 1990. [13] H. Hammouri and M. de LeSn. On systems equivalence and observer synthesis. New Trends in Systems Theory, 340-347, 1991. [14] H. Hammouri and M. Kinnaert. A new procedure for time-varying linearization up to output injection, Syst. Contr. Lett., 28, 151-157, 1996.
70
4. Transformation to State Affine System and Observer Design
[15] H. Keller. 'Nonlinear observer design by transformation into a generalized observer canonical form', Int. J. Control, 46, 1915-1930, 1987. [16] A. J. Krener and W. Respondek. Nonlinear observers with linearizable error dynamics, SIAM J. Contr. Optim., 23, 197-216, 1985. [17] J. de Ledn Morales and S. Acha Daza. Stabilization of a class of nonlinear systems, application to a synchronous generator, Proc. of I A S T E Int. Conf. High technology in the Power Industry, Orlando Fl., USA, 23-26, 1998. [18] J. L~vine and R. Marino, Nonlinear systems immersion, observers and finite dimensional filters, Syst. Contr. Lett., 7 (1986), 133-142. [19] V. Ldpez-M. and A. Glumineau. 'Further results on linearization of nonlinear systems by input output injection', Proc. 36th. CDC IEEE, (San Diego, USA), 1997. [20] V. Ldpez-M. and J. de Ledn Morales and A. Glumineau. Transformation of nonlinear systems into state affine control systems and observer synthesis, IFAC CSSC, Nantes, France, July 8-10, 1998. [21] V. Ldpez-M., F. Plestan and A. Glumineau. Linearization by completely generalized input-output injection, Proc. of 6 th IEEE MCCA, Alghero, Italy, 9-11, 1998. [22] R. Marino and P. Tomei. 'Dynamic output feedback linearization and global stabilization', Syst. Contr. Letters, 17, 115-121, 1991. [23] F. Plestan and B. Cherki. 'An observer for a one flexible joint robot by an algebraic method', Proc. IFA C Workshop on New Trends in Design of Control Systems NTDCS'9~ (Smolenice, Slovakia), 41-46, 1994. [24] F. Plestan and A. Glumineau. 'Linearization by generalized inputoutput injection~t for electrical motor observers', Electrimacs 96 (Saint Nazaire, France), 2/3, 569-574, 1996. [25] F. Plestan and A. Glumineau. 'Linearization by generalized inputoutput injection', Syst. Contr. Letters, 31, 115-128, 1997. [26] T. Proychev and R. L. Mishkov. 'Transformation of nonlinear systems in observer canonical form with reduced dependency on derivatives of the input', Automatica, 29, 495-498, 1993. [27] J. Tsinias. Further results on the observer design problem, Syst. Contr. Lett. ,14, 411-418, 1990. [28] D. Williamson. Observation of bilinear systems with application to biological systems, Automatica, 13, 243-254, 1977.
4. Transformation to State Affine System and Observer Design
71
[291
A. J. Van der Schaft. Representing a nonlinear state space system as a set of higher-order differential equations in the inputs and outputs, Syst. Contr. Lett., 12, 151-160, 1989.
[3o]
F. Viel. Stabilit~ des syst~mes control,s par retour d'~tat estim~. Application aux r~acteurs de polym~risation et aux colonnes ~ distiller, Th~se de Doctorat, Universit~ Claude Bernard-Lyon 1, Lyon, 1994.
[31] X. H. Xia and W. B. Gao. Nonlinear observer design by observer error linearization, SIAM J. Contr. Optim., 1, 199-216, 1989.
On E x i s t e n c e of E x t e n d e d O b s e r v e r s for N o n l i n e a r Discrete-Time Systems H. J. C. Huijberts D e p a r t m e n t of Mathematics and Computing Science Eindhoven University of Technology P.O. Box 513, 5600 MB Eindhoven, The Netherlands
1
Introduction
In this chapter, we consider the design of observers for discrete-time nonlinear systems by means of so called (extended) observer forms. Loosely speaking, a system in observer form is a linear observable (continuous-time or discrete-time) system t h a t is interconnected with an o u t p u t - d e p e n d e n t nonlinearity. Observers for this kind of systems m a y be built by building a classical linear Luenberger observer for the linear system, and adding the output-dependent nonlinearity to this observer. Thus, observer design for systems in observer form is relatively easy. By the same token, also observer design for systems that may be transformed into a system in observer form by means of a coordinate transformation and an output t r a n s f o r m a t i o n is relatively easy. Observer design for systems in observer form was first studied, in the continuous-time setting, in [10],[11] (see also [15]). In these papers, conditions were given under which a nonlinear continuous-time s y s t e m m a y be transformed into a system in observer form by means of a coordinate transformation and an output transformation. Basically, these conditions were given in terms of the integrability of certain codistributions. Later on, the observer design for discrete-time systems in observer form was studied (see [1] ,[12],[13] and the references therein), and conditions were given under which a nonlinear discrete-time system m a y be t r a n s f o r m e d into a system in observer form by means of a coordinate t r a n s f o r m a t i o n and an output transformation. These conditions came down to the question whether certain functions could be factorized in a certain way. For singleoutput systems, conditions under which this factorization is indeed possible were given when only output transformations are allowed. (In fact, [13] also claims to give conditions for the multi-ontput case. However, these conditions seem to be incorrect.) One of the purposes of this chapter is to
74 5. On Existence of Extended Observers for Nonlinear Discrete-Time Systems generalize the conditions given in [13] for single-output systems to the case where, besides a coordinate transformation, also an o u t p u t t r a n s f o r m a t i o n is allowed. T h e conditions for the existence of an observer form for continuous-time systems and discrete-time systems given in [10],[11],[1],[12],[13] are quite restrictive. Therefore, generalizations have been considered, b o t h in the continuous-time case and the discrete-time case. In the continuous-time case, so-called generalized observer forms were considered. These generalized observer forms consist of an observable linear system interconnected with a nonlinearity that depends on the output of the system and a finite number of its derivatives. In [6], differential geometric conditions were given under which a continuous-time system m a y be transformed into a generalized observer form by means of so called generalized coordinate transformations (i.e., transformations that, besides the state of the system, also depend on a finite number of time-derivatives of the outputs) and an output transformation. In the discrete-time context, the design of so called extended observers by using extended observer forms was studied in [7],[8]. Here, an extended observer is an observer that, besides the o u t p u t of the system, also depends on a finite number of its past values, while a s y s t e m in extended observer form consists of an observable linear system interconnected with a nonlinearity t h a t depends on the output of the system and a finite number of past output values. In [7],[8], conditions were given under which a given single-output discrete-time system m a y be t r a n s f o r m e d into a system in extended observer form by means of an extended coordinate transformation (i.e., a coordinate transformation t h a t depends on the state of the system and a finite number of past o u t p u t values) and an output transformation. As in [1],[12], these conditions again boilt down to the question whether a given function m a y be factorized in a certain way. A corollary of the results obtained in [7],[8] is t h a t when the n u m b e r of past output values equals n - 1 (where n is the dimension of the state space of the system under consideration), an extended observer form always exists when the system under consideration is strongly observable (for the exact definition of strong observability, we refer to Section 3). In this chapter, differential geometric conditions for the existence of such a factorization for the cases t h a t the number of past o u t p u t values is smaller t h a n n - 1 will be given. It is to be noted t h a t in principle the problem of observer design is a global problem. Therefore one would also like to obtain global conditions for existence of extended observer forms. However, if one knows t h a t the system under consideration evolves on an invariant set, also existence conditions on this invariant set would suffice. In this chapter, all results obtained will be valid on open invariant sets on which some regularity assumptions hold. Of course, this also includes the case where one really would like to have global conditions. The chapter is organized as follows. In the following section, an overview
5. On Existence of Extended Observers for Nonlinear Discrete-Time Systems
75
of results from the theory of differential forms t h a t will be used in this chapter is given. In Section 3, we consider the existence of observer forms for single-output discrete-time systems. The results in this section reformulate and generalize the results in [13]. In Section 4, the existence of extended observer forms for single-output discrete-time systems is studied. Section 5 contains some conclusions.
2
Differential
Forms
In this section we give an overview of results from the theory of differential forms t h a t will be used in this chapter. For details, we refer to [2],[3],[4],[5],[14]. Let V be an r-dimensional vector space over /R. A k-.form w on V is a k-linear completely antisymmetric m a p p i n g w : V • .-. x V ---* ~ , i.e.,
k times
( w , Z e t~)(vvl, vl, v 2 , . . . , vr ~ v ) ( ~ ( ~ l + Zvl,
~2,.
9 9
~k) = (5.1)
~(~,..
, ~))
, vk) + ~,~(v~, ~ , . . .
(VVl,..- ,v k
E
V)(t.d(Vl,-.. ,vk)
=
(5.2) --~d(Vl,--- , V i - l , V i + l , V i , V i + 2 , "
,vk))
Note t h a t a one-form on V is just an element of V*, the dual of V. The space of all k-forms o11 V is denoted by Ak(V*). It is easily checked t h a t the k-linearity and a n t i - s y m m e t r y of a k-form on V implies t h a t all k-forms are zero for k > r. We define A(V*) := A~
*) (t) A I ( V *) (+)... (]9 A~(V *)
(5.3)
where A~
*) :=
We call A(V*) the exterior algebra over V*. An element w c A(V*) is called a .form on V and m a y be written in a unique way as W :wO-[-wl-J-...~-W
r
(5.4)
where wi E Ai(V *) (i -- 0 , - . . ,r). We next define a product on A(V*), the so called wedge product (or exterior product). This product will be denoted by "A". First, let 7/E Av(v*),
76
5. On Existence of Extended Observers for Nonlinear Discrete-Time Systems
w E Aq(V*). Then 7 A w C AP+q(v *) is defined by (7 A ~ ) ( v i , -
9 - , vp+q) =
E(sign(~))7(v~(1),
- 9 -, v~(p)).4v~(p+l),
9 9 -,
7r
v~(p+q))
(5.5)
where the s u m m a t i o n is over all possible p e r m u t a t i o n s of 1 , . . . ,p 4- q, and Vl,... ,Vp+q C V. For 7 = 7 ~ 4- " " 4- 7 r, w = w ~ 4- ... 4- w r, with 7i,w i c Ai(V *) (i = 0 , . - . ,r), we define
T A w : s 7i Aaj j i,j~o
(5.6)
Note t h a t the wedge-product is associative and distributive, but not commutative. Instead, it satisfies 7 A w = (-1)~qw A 77, 7 e AP(V*),w e Aq(V *)
(5.7)
Let v E V be given. Then the interior product v_J : A(V*) ~ A(V*) is defined in the following way. First consider w E Ak(V*). T h e n v J w C A k - I ( V *) is given by (V--J~d)(Vl,''" , V p _ l ) = • ( V , V 1 , ' ' "
where v l , - . . , 8 9 0 , . . . ,r), then
C V. I f w = w ~
, V p _ 1)
(5.8)
", with w i E Ai(V *) (i = r
(v_l w) -- E(v_I w i)
(5.9)
i=0
Next, consider an n-dimensional manifold M. Let T*M denote the cotangent space at x E M and let T*M denote the cotangent bundle of M. Since T*M is an n-dimensional vector space over ~ , we m a y define A k ( T * M ) for a l l x E M , k = 0 , - . . ,n, as n
A ( T ; M ) := E A k ( T * M ) k=0 We then define the bundles Ak(T*M), A ( T * M ) over M by Ak(T*M):=
U
Ak(T*M),(k=O,,n)
(5.10)
xcM n
A(T*M) := ~ A k ( T * M ) k=0
(5.11)
5. On Existence of Extended Observers for Nonlinear Discrete-Time Systems
77
A differential form on M is now defined to be a s m o o t h section of the b u n d l e A ( T * M ) , while a differential k:form on M is defined to be a s m o o t h section of the bundle A k ( T * M ) . So, roughly speaking, a differential ( k - ) f o r m on M is a "prescription" t h a t assigns a ( k - ) f o r m w~ on T * M to every x C M in a s m o o t h way. Note t h a t by this definition a differential 0-form on M is just a s m o o t h function on M . W h e n no confusion arises, we will simply call a differential ( k - ) f o r m on M a ( k - ) f o r m on M in the sequel. T h e wedge product of the forms 7, w on M is defined to be the f o r m (TAw) satisfying
(t1 A w)x = fix A Wx, (Vx 6 M )
(5.12)
Let 7- be a s m o o t h vector field on M , a n d let w be a form on M . T h e n the interior product (7-Aw) is defined to be the form satisfying
(rn ~)~ = rxn.~x, (Vx ~ M)
(5.13)
T h e exterior differential operator d m a p s a k-form w into a (k + 1)-form dw, called the exterior derivative of w. T h e o p e r a t o r d is uniquely defined by the following properties: 1. d is linear: (Va,/3 E H~)(d(a~/+/3w) = a d r 1 + / 3 d w ) 2. If r/is a k-form, then d(r] A w)
d~ A w
=
+
( - 1 ) k r / A dw
3. d 2 = 0 . 4. If f is a 0-form, then d f is the o r d i n a r y differential df of f . 5. d is local: if r / a n d w coincide on an o p e n set U, then dr/--- dw on U. A k-form c~ is called closed if dc~ -- 0; it is called exact if there exists a ( k - 1)-form r] such t h a t w = dr/. Note that, since d 2 = 0, an exact k-form is closed. T h e converse does not need to hold globally. However, it does hold locally, as is reflected by the following theorem. 5.1 ( P o i n c a r ~ L e m m a ) If M is smoothly contractible to a point xo E M , then every closed.form w on M is exact. Theorem
Let r be a s m o o t h vector field on M . T h e Lie-derivative s m a p s a k-form w into a k-form Z;~w. s is uniquely defined by the following properties: 1. If f is a 0-form on M , t h e n
s
=
TJdf
78
5. On Existence of Extended Observers for Nonlinear Discrete-Time Systems 2. /2, is a derivation: /:~-(~ A w) = r/A L:~-w + l:~-~ A w 3. s
commutes with d: s
= d(s
From the definitions of interior product, exterior derivative, and Liederivative one may derive the following identities t h a t will be frequently used in the sequel (here r., r denote smooth vector fields on M , and w denotes a k-form on M). Z;,w = d(T_lw) + [a, 7]_lw = s
(5.14)
T_ldw
- r_l/:ow(Leibniz - formula)
s
= s163
- g~s
(5.15) (5.16)
Denote by ~tl(M) the set of all one-forms on M. T h e n ~ I ( M ) has the structure of a finitely generated module over the ring of s m o o t h functions on M. A finitely generated submodule of ~1 (M) is called a codistribution on M. The minimal number of generators of a codistribution is called its dimension. A codistribution ~ on M is called integrable if it has a set of generators consisting of exact one-forms. The codistribution generated by a set of one-forms w l , . - - , ~dd is denoted by span{wl, 9-. , ~2d}. For a one-form w and a d-dimensional codistribution ~t, we will say t h a t dw ~ Omod~ if and only if dw
A wl
A
. . . A wd
=
O(Vwl,
. . .
,WdE~)
T h e o r e m 5.2 ( P r o b e n i u s T h e o r e m ) Let M be smoothly contractible to a point xo E M , and let Q be a codistribution on M . Then the .following statements are equivalent. (i) ft is integrable. (ii) For every w E f t we have that dw = 0modfL (iii) Let { w l , ' " ,Wd} be a set o.f generators of f~ and let W d + l , ' ' " ,wn be such that { w l , ' " ,wn} generate f t l ( M ) . T h e n ft is integrable if and only i.f there exist smooth .functions Fikj (i, k = 1 , . . - , d; j = i + 1 , . . . ,n) on M such that dwk = E /=1 j=/+l
F~jwi A w j ( k = 1 , . . . ,d)
(5.17)
5. On Existence of Extended Observers for Nonlinear Discrete-Time Systems
79
In what follows, we will also need the following result. Theorem
If w l , " " ,Wd are independent oneare one-forms such that
5.3 ( C a r t a n ' s
.forms, and 7rl,...
, 7rd
Lemma)
7rl A w] + . - . + TcclA Wd = 0 then 71"i E span{w1,..-
3
,02d}
Observer Design using Observer Forms
We start our investigation of observer design for nonlinear discrete-time systems by considering a nonlinear discrete-time system E of the form
{ z(k +~](k)l) _------ Cz(k)AZ(k)+ (I)O)(k))
(5.18)
with state z E ~/~n, output ~ E ~x~,and where A, C are matrices of appropriate dimensions, the m a p p i n g (I) : ~ ~ H~'~ is smooth, and the pair (C, A) is in Brunovsky form. Analogously to [10],[11], a system of this form is called a system in observer.form. For systems in observer form, observer design is particularly simple. Namely, the fact that the pair (C, A) is in Brunovsky form, and thus in particular observable, implies t h a t there exists a m a t r i x K such that all eigenvalues of the matrix A - K C are in the open unit disc. It is then straightforwardly checked that the following system is an observer for E:
{ 2(k + 1) = ~(k)
=
A 2 ( k ) + K ( ~ ( k ) - y(k)) +
q)(~(k))
c~(k)
(5.19)
We next consider a nonlinear discrete-time system E of the form ~ x ( k + 1) y(k) [
=
=
f(x(k))
h(x(k))
(5.20)
where x E ~'~, y E JT~, and the mappings f : /R n --~ /R '~ and h : ~ -~ are smooth. We will say t h a t E can be put in observer form if there exist a diffeomorphism P : JT~n -~ ~ n of the state space and a diffeomorphism p : ~ ---* h'~ of the output space such t h a t in the new coordinates z = P ( x ) and with the new output ~ = p(y) the system E takes the form (5.18), where the pair (C, A) is in Brunovsky form. If E does admit an observer form, an observer for E m a y then be obtained by first building an observer (5.19) for the observer form (5.18) and then letting ~(k) := P - l ( 2 ( k ) ) be the estimate of x(k).
80
5. On Existence of Extended Observers for Nonlinear Discrete-Time Systems
We thus see that observer design for a discrete-time system E of the form (5.20) is relatively easy when E can be put in observer form. This raises the question under what conditions E can be put in observer form. To derive these conditions, we first introduce the so called observable .form of E. Define the observability map ~ : A n ~ j~n by
h(x) ) ho f(x) . ho f~-l(x)
r
(5.21)
where f l : = f , fk := f o fk-1. Assume that the origin is an equilibrium point of E (i.e., f(0) = 0) and that h(0) ---- 0. We then call E strongly observable on an open subset U C ~ n containing the origin if r is a diffeomorphism on U. It follows that if E is strongly observable on U, then s := r forms a new set of local coordinates for E on U. In these new coordinates, E takes the form
I
s l ( k + 1) Sn_l(~-t-1)
s~(k + 1) y(k)
=
s2(k)
~---
8n(k )
=
fs(s(k)) sl(k)
=
(5.22)
where fs : = h o f,~-I o ~ - 1 . The form (5.22) is referred to as the observable
.form of E. We now have the following result. T h e o r e m 5.4 Consider a nonlinear discrete-time system E of the .form
(5.20), and assume that f(O) = O, h(O) = O. Then r can be put in observer .foT-rn on an open invariant subset U o.f (5.20) containing the origin i.f and only if (i) E is strongly observable on U. (ii) There exist .functions p, r "" , r : ~ ---* ~ , where p is a diffeomorphism on h(U), such that on U the .function fs in (5.22) satisfies p o f~(s) = r
+ r
+"" + r
(5.23)
P r o o f . The proof for the case where only coordinate transformations are considered (or, in other words, the case where p = i d a ) may be found in [13],[8],[9]. The case where also output transformations are considered is an (almost) immediate consequence of the case where p = i d a . 9
5. On Existence of Extended Observers for Nonlinear Discrete-Time Systems
81
If functions p, r , r : ~ --* ~ exist such t h a t fs satisfies (5.23), we define the following c o o r d i n a t e change: i--1
z~ := p ( s d - ~
Cj(s~_j)(i = 1 , . - , n)
(5.24)
j=l
In these new coordinates, we obtain the observer form for E: =
z2(k)+r
z~_l(k)
=
z~(k)+~n_l(~(k))
~(k)
=
z~(~)
zl(k+l)
(5.25)
where r : = r o p - 1 . From T h e o r e m 5.4, it follows t h a t the question w h e t h e r or not E can be p u t in observer form m a y be reduced to the question w h e t h e r or n o t the function fs in (5.22) m a y be w r i t t e n in the special form (5.23). We will now derive conditions on fs under which this is possible 9 To this end, we define one-forms w l , - . . , wn by
~i :=
j=l
/~ \ as s )
1,
,n)
(5.26)
For the case t h a t p = i d ~ we t h e n have the following result. 5.5 Consider a discrete-time system E of the .form (5.20) that is strongly observable on an open inva~iant subset U C ~:~'~ containing the origin. Assume further that U is smoothly contractible to the origin, and that the one-forms W l , " " ,Wn in (5.26) generate a codistribution on U. Then E can be put in observer .form with p = idt~ on U i.f and only if the one-forms W l , " " , wn in (5.26) satisfy
Theorem
dwi = 0(i = 1 , . . . ,n)
(5.27)
P r o o f . (necessity) Follows by direct verification. (sufficiency) A s s u m e t h a t the one-forms wi in (5.26) satisfy (5.27). It then follows from (5.26,5.27) t h a t
0--d~
.....
~
dskAdsj(i=l,...,n)(5.28)
~=1 k = i + l
which is equivalent to
(OskOsj 02fs ) = 0 ( j , k = l , - - .
, n ; j 7~ k)
C5.29)
82
5. On Existence of Extended Observers for Nonlinear Discrete-Time Systems
This implies t h a t there exist functions r satisfies (5.23) with p = i d a . 9
,r
: ~ ~ ~ such t h a t f~
We next give conditions under which f~ m a y be w r i t t e n in t h e f o r m (5.23), where p r i d a . To do this, we let r l , . . . ,7~ be vector fields t h a t are dual to the one-forms CO1,"" ,w,~ in (5.26), i.e.,
TiJ wj --- 6ij (i, j = 1 , . . . , n)
(5.30)
where 5ij is the Kronecker delta. T h e o r e m 5.6 Consider a discrete-time system E of the .forvn (5.20) that is strongly observable on an open invariant subset U C ~ n containing the origin. A s s u m e .further that U is smoothly contractible to the origin, and that the one-forms co1,"" ,COn in (5.26) generate a codistribution on U. Then the .following statements are equivalent:
(i) ~ can be put in observer .form on U. (ii) There exists a .function S : U -~ ~7~ such that dCOi := d S A wi(i = 1 , . . . ,n) (iii) The one-forms
CO1,'''
, COn
(5.31)
and the vector fields r a , " " , r~ satisfy
dCOi A COj + dCOj Awi = 0(i, j = 1 , . . - , n)
(5.32)
and
(5.33) P r o o f . ( i ) ~ (ii) Assume t h a t E can be p u t in observer form on U. Define one-forms &i by
~i : =
j=l
\
Osj
It t h e n follows from T h e o r e m 5.5 t h a t we have t h a t d~i = 0(i = 1 , . - . ,n)
(5.35)
Together with the fact t h a t &i = (P' o f~)w~, this gives t h a t O = & S i = d (p,~s
A&~ (5.36)
(p' o f~)d (p,~s ) A w i = d ( - log Ip' v fs]) A col
5. On Existence of Extended Observers for Nonlinear Discrete-Time Systems
83
which establishes our claim for S : = - log {p~ o f~{. ( i i ) ~ ( i ) A s s u m e t h a t there exists a function S : g ~ h~ such t h a t (5.31) holds. Since wn = df~, (5.31) for i = n gives t h a t d S A df~ = 0. B y C a r t a n ' s L e m m a , this gives t h a t d S E span{df~}. Define T : = e x p ( - S ) . We t h e n also have t h a t d T E span{df~}, which implies t h a t there exists a f u n c t i o n /5 : ~ ~ ~ such t h a t T = / 5 o f~. Define p : _t~ ~ ~ by p : = f p ( T ) d % a n d define one-forms & l , " " , &,~ as in (5.34). N o t e t h a t we t h e n have t h a t 9 = Twi (i = 1 , . . . , n), which implies t h a t d&i = Tdw~ + d T A w i = T ( d w i - d S A wi) = O(i = 1 , . . . , n)
(5.37)
Together with T h e o r e m 5.5 this establishes our claim. (ii)~=~(iii) We first show t h a t (5.32) is equivalent to the existence of a unique one-form 71 such t h a t awl = ~] A wi(i = 1 , . . . , n)
(5.38)
Note t h a t if there exists a one-form V such t h a t (5.38) holds, t h e n (5.32) follows immediately. Conversely, assume t h a t (5.32) holds. For i = j, (5.32) gives in particular t h a t dwi A wi = 0 (i = 1,. 9 9 , n). It t h e n follows from the Frobenius T h e o r e m t h a t there exist one-forms P l , " " , pn such t h a t dwi = Pi A a~i(i = 1 , - . . ,n)
(5.39)
rt
Writing p~ = ~ k = l pikcok (i = 1 , - . . , n), we then o b t a i n from (5.32) t h a t 0 = dcoi A wj + doaj A aJi . . . . .
~ k=
(pit: - pjk)wk A w i A wj
(5.40)
I
k#i,j which gives t h a t Pik = p j k ( i , j , k = 1 , . . . , n ; k r i , j )
(5.41)
This i m m e d i a t e l y implies t h a t indeed there exists a unique one-form r / s u c h t h a t (5.38) holds. W h a t remains to be done, is to show t h a t there locally exists a function S such t h a t 7] = d S if a n d only if (5.33) holds. W r i t i n g :
n
Ej=I
7]jO.)j, w e
have that
n
n--1
d~ = ~-~(drlj A wj + ~ j d w j ) . . . . . j=l
~
(s
- g,-j~i)wi A wj
j=l i=j+l
(5.42) B y the Poincar~ L e m m a , this gives t h a t there exists a function S : U ~ such t h a t rI = d S if a n d only if /2~j
=/:~,rli(i, j = 1 , . . - , n)
(5.43)
Using (5.15),(5.14), it is straightforwardly checked t h a t ~y = [T~,Tj]_I w~. Together with (5.43), this yields (5.33), which establishes our claim. 9
84
5. On Existence of Extended Observers for Nonlinear Discrete-Time Systems
4
Observer Design using Extended Observer Forms
In the previous section, we have seen t h a t observer design for a nonlinear discrete-time system (5.20) is relatively easy when the system can be put in observer form (5.18). Unfortunately, however, the conditions for existence of an observer form given in T h e o r e m 5.4 are quite restrictive. In this section, we will relax these conditions by considering so called extended observers and extended observer .forms. We will first explain what is meant by an extended observer. Consider a system E of the form (5.20), and let N E ~V be given. We now assume t h a t at every time instant k > N we do not only know the output y(k) at t i m e k, but also the past outputs y(k - 1),-. - , y(k - N). An extended observer with buffer N for E then is a dynamical system E of the form E : ~(k + 1) --- f ' ( ~ ( k ) , y ( k ) , - - . , y ( k - N ) ) , k _> N where ~ E ~ ' ~ and the m a p p i n g f ' : /R n + g + l ~ ff~'~ is smooth, with the property t h a t x(k) - ~(k) --* 0 (k ~ oo), for all x(0), ~ ( N ) E ff~n. To study the design of extended observers for a discrete-time system E of the form (5.20), we first consider a system E~ of the form
~
[
z ( k + l) 9(k)
= =
Az(k)+O(~(k),... ,~)(k-N)) Cz(k)
(5.44)
where the state z E ~'~, the output ~ E ~ , A, C are matrices of a p p r o p r i a t e dimensions, the mapping ~ : ~ g + l ~ ~,~ is smooth, and the pair (C, A) is in Brunovsky form. Note that for N = 0 the system E~ is identical to the system E in (5.18). Therefore, a system E~ of the form (5.44) will be referred to as a system in extended observer.form with buffer N. As for a system in observer form, the design of an extended observer for a s y s t e m in extended observer form is relatively easy. Namely, it is straightforwardly checked that the system
{
E(k + 1)
=
AE(k) + K(~](k) - y(k)) + O(~)(k),... ,~)(k - N ) )
=
c
(k)
(5.45) where the matrix K is such that all eigenvalues of A - K C are in the open unit disc, is an extended observer for E ~. As in the previous section, we now consider the question under which conditions a given discrete-time system can be put in extended observer form for some N E / N . The transformations we are going to use here, are more general t h a n the ones in the previous section, in the sense t h a t we also allow them to depend on the past output measurements y ( k - 1 ) , - . 9 , y ( k N). More specifically, we will be looking at p a r a m e t r i z e d transformations Z = /:~(X, ~ n , ' ' " , ~N), where z E ~ n , with the property t h a t there exists a
5. On Existence of Extended Observers for Nonlinear Discrete-Time Systems
85
m a p p i n g p - l ( . , f l , ' " 9 , iN) : ~ n __~ ~ n p a r a m e t r i z e d by (fl," " " , i N ) such t h a t for all ( f l , " " , iN) we have t h a t
P(P-l(z, fl,""
,fN),fl,''"
,iN)
:
Z
A m a p p i n g having this property will be referred to as an extended coordinate change. We will then say t h a t the system (5.20) can be put in extended observer .form with buffer N if there exists an extended coordinate change P ( ' , fl," "" , iN) : ~ n --, ~ n parametrized by (fl," "" , iN) and a diffeomorphism p : / R -~ H~ of the output space such t h a t the variable
z(k) := P ( x ( k ) , y(k - 1),--. , y(k - N ) )
(5.46)
satisfies (5.44), where ~) :-- p(y), and the pair (C, A) is in Brunovsky form. As pointed out above, one m a y then build an extended observer (5.45) for z(k) in (5.46). From this extended observer, one then obtains an e s t i m a t e ~(k) for x(k) by inverting the extended transformation P: ~(k) := P - l ( ' d ( k ) , y ( k - 1 ) , . . - , y ( k -
N)),k > N
(5.47)
The following generalization of T h e o r e m 5.4 gives conditions under which a discrete-time system (5.20) can be put in extended observer form. 5.7 Consider a nonlinear discrete-time system (5.20), and assume that f(O) = O, h(O) = O. Let N E be given. Then E can be put in observer .form with buffer invariant subset U C ~ztn containing the origin i.f and only
E of the .form
Theorem
{ 0 , . . . , n - 1}
N on an open if
(i) E is strongly obsewable on U. (ii) There exist .functions r ,r : ~ N + I --~ ~ and a diffeomorphism p on h(V), such that on V the .function fs in (5.22) satisfies n-N
p o f~(s) ---- E
r
, si)
(5.48)
i=1
P r o o f . The proof for the case where only coordinate transformations are considered (or, in other words, the case where p = idt~) m a y be found in [8]. The case where also output transformations are considered is an (almost) immediate consequence of the case where p = idt~. 9
If there exist functions p, r defines the following variables:
,
Cn-N such t h a t fs satisfies (5.48), one
z (k) E Cj(s~_j(k),..- , s l ( k ) , y ( k j=l
(i----1,...,n)
1),--. , y ( k -
N-
1 +i-j))
(5.49)
86 5. On Existence of Extended Observers for Nonlinear Discrete-Time Systems where c~i : = m i n i / t~ y + l by
~)n-N : ~ N + I
1, n - N). Further, define r
~i(~1,''" ,~N+I) : : (~I(p--I(~I),''" ,P--I(~N+I)) (i=l,-.-,n-N) It m a y t h e n be shown t h a t in these variables we o b t a i n the following ext e n d e d observer form: zl(k-4- 1)
=
z2(k)
+ q~l(y(k),... ,y(k -
N))
z,~_g(k+ 1)
=
Zn_NA-l(k)-~-~n_N(y(]'g),''"
z n - g + l ( k + 1)
=
Zn-N+2(k)
= = =
o z (k)
zn_l(k
+ 1)
,y(]~ -- g ) )
(5.50)
Note t h a t T h e o r e m 5.7 generalizes T h e o r e m 5.4. ~hlrther, f r o m T h e o r e m 5.7, we o b t a i n the following result for N = n - 1 (see also [7],[8]). C o r o l l a r y 5.1 Consider a nonlinear discrete-time s y s t e m E of the .form (5.20), and assume that f ( 0 ) = 0, h(0) = 0. Then E can be put in observer .form with buffer N on an open invariant subset U C i~:tn containing the o,~igin i.f and only i.f E is strongly observable on U. Thus, we see t h a t every strongly observable s y s t e m can be p u t in ext e n d e d observer with buffer N = n - 1. F r o m a practical point of view, e.g. when n is large, it m a y be desirable to reduce the size of the buffer. T h e r e fore, we next investigate under which conditions an e x t e n d e d observer with buffer N E { 1 , . . . , n - 2} exists. As in the previous section, these conditions are again given in terms of the one-forms wi in (5.26) a n d the vector fields ~-~ in (5.30). Using the one-forms w~ in (5.26), we define the following codistributions: ~i : = span{wk - wk-1 ] k = i + 1 , . - . , m i n ( n , i + N ) } ( i = 1 , . . . , n ) (5.51)
~i : = s p a n { w ~ , . . - , w i + g } ( i = 1 , . . . , n - - N -
1)
(5.52)
We first consider the case w i t h o u t o u t p u t t r a n s f o r m a t i o n s , i.e., the case where in (5.48) we have t h a t p = i d a . This result generalizes T h e o r e m 5.5. T h e o r e m 5.8 Consider a discrete-time s y s t e m E o.f the .form (5.20) that is strongly observable on an open invariant subset U C ~ n containing the
5. On Existence of E x t e n d e d Observers for Nonlinear Discrete-Time Systems
87
origin. A s s u m e .further that U is smoothly contractible to the origin, and that the o n e - f o r m s wl , . . . , a~n in (5.26) generate a codistribution on U. L e t N E {1,. - 9 , n - 2} be given. T h e n .for p = i d a , E can be p u t in extended observer .form with buffer N on U i f and only i f the o n e - f o r m s wi in (5.26) satisfy dwi ~- 0 m o d f ~ i ( i = 1 , - - - , n )
(5.53)
P r o o f . (necessity) Follows b y d i r e c t v e r i f i c a t i o n . (sufficiency) A s s u m e t h a t t h e o n e - f o r m s wi i n (5.26) s a t i s f y (5.53). N o t e t h a t b y t h e d e f i n i t i o n of t h e wi we h a v e t h a t f~i = s p a n { d s k [ k = i + 1 , - . . , r a i n ( n , i + N ) } ( i = 1 , - - - , n ) D e f i n i n g c~i : = r a i n ( n , i + N ) (i = 1 , - - . , n ) , (5.53) t h e n gives
0 = dwi A dSi+l A 9 .. A d s ~ . . . . . i
E j=l
E
(\ os~.Os~ o s, ))
k=c~i+l
'
A
A
A.. A
(5.54)
"
(i = 1 , . . . , n ) w h i c h is e q u i v a l e n t to
( Osksj o2f ])
= O(j, k = 1 , . . . ,n; IJ - kl > n)
(5.55)
I t is e a s i l y checked t h a t t h i s c o n d i t i o n is e q u i v a l e n t t o t h e e x i s t e n c e of f u n c t i o n s 4 ) 1 , " " , c/)~-N s u c h t h a t fs satisfies (5.48). 9 F o r t h e case t h a t in (5.48) we h a v e t h a t p ~ i d a , t h e f o l l o w i n g r e s u l t holds. Theorem 5 . 9 Consider a discrete-time s y s t e m E o.f the .form (5.20) that is strongly observable on an open i n v a r i a n t subset U C ~T~~ c o n t a i n i n g the origin. A s s u m e .further that U is smoothly contractible to the origin, and that the o n e : f o r m s Wl,. 9 9 , wn in (5.26) generate a codistribution on U. L e t N E {1, - 9 9 , n - 2} be given. T h e n the .following s t a t e m e n t s are equivalent:
(i) E can be p u t in extended observer .form with buffer N on U. (ii) There exists a .function U : ~
-~ ~zt such that
dwi - d S A wi = 0 m o d f t i ( i = 1 , - . . , n )
(5.56)
(iii) The o n e : f o r m s wl," " 9 , wn and the vector .fields ml,. 9 9 , "r,~ satisfy daJi - 0 m o d F t l + s p a n { w n } ( i = 1 , . - . , n - N - 1)
(5.57)
88
5. On Existence of Extended Observers for Nonlinear Discrete-Time Systems dwi =- 0 m o d ~ i ( i = 1 , . - . , n - N - 1)
(~.ss)
dwi -=- 0modf~i(i
(5.59)
= n-
N,...
,n -
1)
[cri, 7,]_lwn = [c~j, T n ] J w ~ ( i , j = 1 , . . , n -
N-
I,''" ,n-- N--1;j=
l,...
s
1)
(5.60)
,n--l)
(5.61)
where the vector.fields or1,... , crn_N_l are de.fined by o'i
:=
T i ~ - " "" n a T i + N ( i
----
1 , . . . , n - N - 1)
(5.62)
P r o o f . ( i ) ~ ( i i ) A s s u m e t h a t there exist functions p, r , C n - N , such t h a t p is a diffeomorphism on h ( U ) a n d fs satisfies (5.48). Define o n e - f o r m s &l,'", 9 by
o?i :=
( O(po_f,) ~ dsj(i = 1,... j=l
\
n)
Osj ]
(5.63)
T h e n it follows from T h e o r e m 5.8 t h a t d&i ~ 0modspan{ 9
- 0~k_ 1 I k =
i + 1,... ,min(n,i + N)} (5.64)
(i = 1 , . - - ,n) Note t h a t we have t h a t &~ = ( p ' o f ~ ) w i (i = 1, .. , n). Defining the f u n c t i o n S := - log IP' o fsl, this gives 1 d '[p ' 0 f s ) ) A --:--: dwi - d S A w i = d (:---k--~.) p'of8 ~ -~ [~-~-~.~ p'of., o?z. . . . . .
p'~I., d&i(i = 1,--- , n)
(5.65) Further, it follows t h a t
span{i~2k -- ~]k--1 I ]~ ~---i ~- 1,--. , m i n ( n , i + N ) }
= f~i(i = 1,--.
,n) (5.66)
O u r claim is then established by combining (5.64),(5.65),(5.66). ( i i ) ~ (i) A s s u m e t h a t there exists a function S : U ~ H~ such t h a t (5.56) holds. Note t h a t from (5.26) we have t h a t wn -- df~. Thus, (5.56) for i = n gives t h a t 0 = dwn - d S A wn = - d S A wn
(5.67)
5. On Existence of Extended Observers for Nonlinear Discrete-Time Systems
89
By C a r t a n ' s L e m m a , this gives t h a t d S e span{dfs}. Define T : = e x p ( - S ) . T h e n we also have t h a t d T E span{df~}, a n d thus there exists a f u n c t i o n t5 : ~ --~ ~ such t h a t T = 15 o f~. Define p : = f i S ( r ) d r , a n d one-forms 9 , 9 as in (5.63). We t h e n have t h a t &i = Taxi (i = 1 , . . . ,n), a n d thus d&i = d T
Awi +
Tdwi = T(d~i - dS
Awi)
=-- 0modf~i(i = 1,--- , n) (5.68)
Together with T h e o r e m 5.8, this establishes our claim. (ii)r F r o m the fact t h a t ~,~ = dfs, it follows t h a t the f u n c t i o n S t h a t needs to exist has to satisfy d S A w n . By C a r t a n ' s L e m m a , this implies t h a t there should exist a function a such t h a t d S = o~w,~ a n d da A w~=O
(5.69)
Thus, the existence of a function S such t h a t (5.56) holds is equivalent to the existence of a function a satisfying (5.69) a n d dwi - (~Wn A wi -- 0 m o d f t i ( i = 1,. -- , n - 1)
(5.7o)
We now have t h a t a two-form w 2 satisfies w 2 _= 0mode2 for some codistrib u t i o n 12 if and only if X_I Y_I w 2 for all X, Y E f t • It is easily checked t h a t we have ~/l = span{r1,- 9 , ri_], r i + N + l , ' ' '
, r~, c~i}
(5.71) (i = 1 , - . . , n -
N-
1)
and 12~ = s p a n { r 1 , . . . , r i _ l , c l i } ( i = n -
N,-.. ,n-
1)
(5.72)
where, analogously to (5.62), we have :=
+...
+
= n - N,...
, n - 1)
(5.73)
NoB, let i E {1,--- , n -- N - 1} be given. We t h e n have 0 = %_1 re-I (da;i - a w n A w i ) = "rkJ re-I dwi = ['rk, re]-I wi (5.74) (k,(=l,...
,i-l,i+N+l,...
,n)
0 ---- Tk--I 0",_1 (dwi - aw,~ A wi) = "rk-I o'{_1 dw{ = [%, o-{]_.1 oJ{ (5.75) (k=l,.-.,i-l,i+N+l,---,n-1)
90
5. On Existence of Extended Observers for Nonlinear Discrete-Time Systems
and 0 = cr~AT,~_I(dcvi - awn A wi) = cri--I7nA dwl - a = [cri, 7-n]-Iw~ - a (5.76) Where in (5.74),(5.75),(5.76) and (5.14). Combining (5.74) ther, (5.76) gives (5.60), while Next, let i E {n - N , - . . , n -
the last equality follows by applying (5.15) and (5.75), we obtain (5.57) and (5.58). Furcombining (5.69) and (5.76) we obtain (5.61). 1} be given. We then have
0 = Tk/Te-I (dwi - o~w,, Awi) = 7k-I r e / d w i = [Tk, Te].-Iwi (5.77)
(k,e =
1,...
,i -
1)
and 0 = 7 k l c~iI (dwi - ozwn A wi) = Tk I cril dwi = [7k, ai] I wi
(5.78) (k=l,...,i-1) Combining (5.77) and (5.78), we then obtain (5.59). m R e m a r k 5.1 Theorem 5.9 generalizes Theorem 5.6. From the .first two items of both theorems this is seen immediately. I f however, one considers the third i t e m of both theorems the generalization is .far.from obvious at .first sight. This is due to the .fact that the equivalence (ii)~==>(iii) in Theorem 5. 6 holds .for general independent one:forms W l , ' " ,Wn, while this equivalence in Theorem 5.9 only holds .for Oneaforms w l , " ' , w , of the .form (5.26).
5
Conclusions
In this chapter, we have given conditions for the existence of extended observer forms and extended observers for single-output nonlinear discretetime systems. All conditions are valid on an open invariant subset of the state space t h a t is smoothly contractible to an equilibrium point of the system and on which some regularity assumptions are satisfied. This raises the question what can be said for the case t h a t (some of) the regularity assumptions are not satisfied. This remains a topic for future research. A further topic for future research would be the question when extended observer forms and extended observers for multi-output discrete-time systems exist. As also mentioned in the Introduction, it seems t h a t the conditions given in [13] for the existence of an observer form when only coordinate transformations are allowed, seem to be incorrect. Preliminary investigations suggest that in fact the problem of coining up with correct conditions m a y be quite intractable. On the other hand however, it m a y
5. On Existence of Extended Observers for Nonlinear Discrete-Time Systems 91 be shown by using the same techniques as in [7],[8] that a strongly observable multi-output system may always be put in observer form with buffer N = n* - 1, where n* equals the maximal so called observability index of the system.
Acknowledgments Part of this research was performed while the author was visiting the Laboratoire d'Automatique de Nantes, Nantes, France, supported by a grant from the R6gion Pays de la Loire. 6
REFERENCES [1] M. Brodmann. Beobachterentwur.f .fiir nichtlineare zeitdiskrete Systeme, VDI Verlag, D~isseldorf, 1994. [2] R. L. Bryant, S. S. Chern, R.B. Gardner, H.L. Goldschmidt and P.A. Griffiths, Ezterior differential systems, Springer, New York, 1991. [3] H. Cartan. Formes diff~rentielles, Hermann, Paris, 1967. [4] Y. Choquet-Bruhat and C. DeWitt-Morette (with M. Dillard-Bleick), Anaysis, manifolds and physics, Part I: Basics, North-Holland, Amsterdam, 1991. [5] H. Flanders. Differential forms with applications to the physical sciences, Dover, New York, 1989. [6] A. Glumineau, C.H. Moog and F. Plestan. New algebro-geometric conditions .for the linearization by input-output injection, IEEE Trans. Automat. Control, 41, pp. 598-603, 1996. [7] H. J.C. Huijberts, T. Lilge and H. Nijmeijer. A control perspective on synchronization and the Takens-Aeyels-Sauer Reconstruction Theorem, to appear in Phys. Rev. E, 1999. [8] H. J. C. Hnijberts, T. Lilge and H. Nijmeijer. Synchronization and observers for nonlinear discrete time systems, submitted to European Control Conference 1999. [9] H. J. C. Huijberts, H. Nijmeijer, and A.Yu. Pogromsky. Discrete-time observers and synchronization, in G. Chen (Ed.), Controlling chaos and bifurcations in engineering systems, CRC Press, Boca Raton, Florida, 1999.
[10] A. J. Krener and A. Isidori. Linearization by output injection and nonlinear observers, Syst. Control Lett., 3, pp. 47-52, 1983.
92
5. On Existence of Extended Observers for Nonlinear Discrete-Time Systems
[11] A. J. Krener and W. Respondek. Nonlinear observers with linearizable error dynamics, SIAM J. Control Optimiz., 23, pp. 197-216, 1985. [12] T. Lilge. On observer design for nonlinear discrete-time systems, Eur. J. Control, 4, pp. 306-319, 1998.
[13]
W. Lin and C.I. Byrnes. Remarks on linearization of discrete-time autonomous systems and nonlinear observer design, Syst. Control Lett., 25, pp. 31-40, 1995.
[14] M. Spivak. A comprehensive introduction to differential geometry, Volume I, Publish or Perish, Houston, 1979. [15] X. Xia and W. Gao. Nonlinear observer design by observer canonical forms, Int. J. Control, 47, pp. 1081-1100, 1988.
Stability Analysis and Observer Design for Nonlinear Diffusion Processes Winfried Lohmiller and Jean-Jacques E. Slotine
Nonlinear Systems Laboratory Massachusetts Institute of Technology Cambridge, Massachusetts, 02139, USA
1
Introduction
The stability of a nonlinear reaction-diffusion process and its convergence rate can be determined very simply. This allows in turn the design of simple observers for such processes. The technique is based on an extension of the recently developed tools of contraction theory. Reaction-diffusion processes are pervasive in physics. Mathematical properties such as existence and smoothness of solutions are well understood for many such processes (Evans [3]). This paper shows that analyzing global stability - are initial conditions or temporary disturbances eventually "forgotten," and if so, how fast? - and determining convergence rates given boundary conditions is very simple for such processes, and shows how this result applies naturally to the design of observers. This is achieved by taking advantage of recent results on stability theory, referred to as contraction analysis (Lohmiller and Slotine [8]), and extending them to partial differential equations describing nonlinear reaction-diffusion processes. After a brief review of contraction analysis in Section 2, Section 3 analyzes the contraction properties of the Laplace operator with general boundary conditions. The result is applied to reaction-diffusion equations of the form
c9_~r = h(t) V2r + g(t) V r + f ( r Ot
(6.1)
whose stability and convergence rates are explicitly quantified, and then to exponentially convergent observer designs for these systems. Numerical aspects are discussed in Section 4, and extensions to other classes of distributed systems in Section 5.
94
6. Stability Analysis and Observer Design for Nonlinear Diffusion Processes
2
Contraction Analysis
Differential approximation is the basis of all linearized stability analysis. W h a t is new in contraction analysis is that differential stability analysis can be made exact, and in turn yield global results on the nonlinear system. We first summarize some basic results of (Lohmiller and Slotine [8]), to which the reader is referred for more details, and then discuss how these results apply naturally to the design of nonlinear observers.
2.1
Basic Tools
We consider general deterministic systems of the form ~=f(O,t)
(6.2)
where 9 is the n • 1 state vector and f is an n • 1 nonlinear vector field, All quantities are assumed to be real and smooth, so that we can write the exact differential relation 0f 5 6 = ~--~(O, t) 5 0
(6.3)
where $0 is a virtual displacement - recall that a virtual displacement is an infinitesimal displacement at .fixed time. Note t h a t virtual displacements, pervasive in physics and in the calculus of variations, are also well-defined m a t h e m a t i c a l objects (Arnold [1] and Schwartz [10]). Consider now two neighboring trajectories in the flow field ~ = f(O, t), and the virtual displacement 50 between them (1). The squared distance between these two trajectories can be defined as ~ 0 T 6 0 , leading from (6.3) to the rate of change
virtual displacement 8 ~
velocity 8
two neighboring traiectories
~K
FIGURE 1. Virtual dynamics of two neighboring trajectories.
6. Stability Analysis and Observer Design for Nonlinear Diffusion Processes d ( ~ ~ T (~~ ) = 2 5 ff2T h Oo = 2 5r T ~--~f~ hrb < 2 /~max ~ O T ~ o
95
(6.4)
where Am~x(q~,t) denotes the largest eigenvalue of the symmetric part of of i.e., the largest eigenvalue of 7(b-~ o of ~ + 1 of T~j. Assume now the Jacobian b-~, that Am~x(q),t) is uniformly strictly negative (i.e., 3 /3 > 0, VO, Vt _> 0, Amax(gP,t) < --Z < 0. ). Then, from (6.4) any infinitesimal length [[5~][ converges exponentially to zero. By path integration, this immediately implies that the length of any finite path converges exponentially to zero. Thus, as in stable linear time-invariant systems, the initial conditions are exponentially "forgotten." We can state the following definition and basic result (Lohmiller and Slotine [8]) T h e o r e m 6.1 The system (~ = f(qh, t) is said to be contracting if -of ~ is uni.formly negative definite. All system trajectories then converge exponentially to a single trajectory, with convergence rate IAm~l, where )~max i8 Of the largest eigenvalue of the symmetric part of -5"~" The system is called semi-contracting if b-~ of is only negative semi-definite, and indifferent if of is skew-symmetric. More precise local versions of the above theorem can also be derived. In addition, departing further from classical Krasovskii-like results for autonomous systems (Krasosvkii [6], Hahn [5] and [7]), the approach can be vastly extended by allowing for a prior differential coordinate transformation, leading to a a necessary and sufficient condition for global exponential convergence (Lohmiller and Slotine [8]). Specifically, the line vector 5~ between two neighboring trajectories in Figure 1 can also be expressed using the differential coordinate transformation = o
(6.5)
where O(q~, t) is a square matrix. This leads to a generalization of our earlier definition of squared length 6~JT 6tII = 5 0 T M
5~
(6.6)
where M(O, t) = o T o represents a symmetric and continuously differentiable metric - formally, equation (6.6) defines a Riemann space (Lovelock and Rund [9]). Since (6.5) is in general not integrable, we cannot expect to find explicit new coordinates ~(O,t), but 6~ and 5 ~ T 5 ~ can always be defined. We require M to be uniformly positive definite, so that exponential convergence of 50 to 0 also implies exponential convergence of 5q~ to 0. Distance between two points P1 and P2 with respect to the metric M is defined as the shortest path length (i.e., the smallest path integral f 2 ~ [15~l] ) between these two points. Accordingly, a ball of center c and radius R is defined as the set of all points whose distance to e with respect
96
6. Stability Analysis and Observer Design for Nonlinear Diffusion Processes
to M is strictly less than R. Computing I
d 5~ = F S ~ dt
or alternatively ~-~
where
F---(E)+o0f)o
0,)
\ ~ - ~ M + 1~I + M~-~
-1
(6.7)
5(I)
(6.8)
we can state the following definition and main result (Lohmiller and Slotine
[8]) D e f i n i t i o n 6.1 Given the system equations ~ = f(O,t), a region of the state space is called a contraction region with respect to a uniformly positive de.finite metric M(O, t) = OTO i f F in (6.7) or equivalently ~O 0 T M ~- - - M Oof 4cP -1(r is uniformly negative de.finite in that region. Regions where F is negative semi-definite are called semi-contracting, and regions where F is skew-symmetric are called indifferent. T h e o r e m 6.2 Given the system equations ~ = f(O,t), any trajectory, which starts in a ball of constant radius with respect to the metric M(O,t), centered at a given trajectory and contained at all times in a contraction region with respect to M(O,t), remains in that ball and converges exponentially to this trajectory. Furthermore global exponential convergence to the given trajectory is guaranteed if the whole state space is a contraction region with respect to the metric M(O,t). It can be shown that the existence of a uniformly positive definite metric with respect to which the whole state space is a contraction region is actually a necessary condition for global exponential convergence. In the linear time-invariant case, a system is globally contracting if and only if it is strictly stable, with F simply being a normal Jordan form of the system and O the coordinate transformation to that form. Note that the metric is unchanged by an additional (perhaps time-varying or state-dependent) orthonormal transformation, i.e., by left-multiplying O by an orthonormal matrix. 2.2
Nonlinear Observer Design using Contraction
Theory
By using a differential approach, contraction theory in a sense treats convergence analysis and limit behavior separately. Guaranteeing contraction means that after exponential transients the system's behavior will be independent of the initial conditions. In a control context, once contraction is guaranteed through feedback, specifying the final behavior reduces to the problem of shaping one particular solution, i.e. specifying an adequate
6. Stability Analysis and Observer Design for Nonlinear Diffusion Processes
97
open-loop control input to be added to the feedback terms, a necessary step of any control method. In an nonlinear observer context, contraction theory is a rather natural tool, since once the observer contraction behavior has been shown and quantified, one needs only verify t h a t the observer equations contain the actual plant state as a particular solution to automatically guarantee convergence to t h a t state. If y((I), t) is the available m e a s u r e m e n t vector, and q) the estimated state, with ~, = y(q), t), this m a y be achieved by simply copying the system dynamics (identity observer) and adding to the right-hand side a term of the form k ( p , t) - k ( y , t) , where the vector field k is selected to guarantee or enhance the contraction behavior of the observer. W h e n the actual system is itself contracting, as will be the case for most of the nonlinear diffusion processes considered in this paper, k needs only to be selected to enhance (speed up) the natural contraction behavior of the system.
2.3
Weakly Contracting Systems
In this section we derive an exponential convergence condition for classes of semi-contracting systems. The idea is simple: whereas in Section 2 we have used only first time-derivatives of a virtual displacement to characterize a flow field, we now perform a complete Taylor series expansion to analyze a semi-contracting virtual dynamics. This section m a y be skipped in a first reading, as it will only be needed for an extension in Section 5. Consider a semi-contracting, analytic virtual dynamics in 5 ~ d The corresponding virtual length dynamics is
d (e~Te~)=--2er dt T
with positive semi-definite F~ = - ~1 ( F + F T ) . Factorizing F s as x / ~ v ~ , say with a Cholesky factorization, allows one to compute the time-derivatives of (~tI/T~ / as
o
T
dt 2 d3 =
+
2 L l v ~ T nlv/-Fs + n o v ~ sT n2x/F~)~k0
98
6. Stability Analysis and Observer Design for Nonlinear Diffusion Processes
with the Lie derivatives L J v ~ ( x , L~
=
t) (Lovelock and R u n d [9])
~;~
-- L ~ v ~ F + ~ L J v ~
vj>_o
dt
As a result 6k~T6k~(t A- T ) along a trajectory x(t) can be written as the Taylor series expansion
(
6q2T6q~(t + T )
<
TT 2
~-.3 2T
-~.4 3T
T~
3~_._~ 4
4~ 5
. 9 9"
) LOv/-~8
LIv/-Fs
~
6ff2T6ff2
_ ~ ~RLOv,-f2 L1,/-f~ ...)
L~,/-f~
~
where all the terms on the right hand side are c o m p u t e d at time t. Note t h a t for a given constant T > 0 the interior matrix above can be shown by complete induction to be uniformly positive definite, which implies a uniformly positive ~. As a result we can conclude on exponential convergence of 116q211 to zero for uniformly positive definite C T C with
C =
( L~ ) L1 v/-Fs
(6.9)
Contrary to linear time-invariant systems the rank of C can be increased with additional Lie derivatives L i v e 8 . However, once C T C is uniformly positive definite for some finite number of Lie derivatives the following ones do not influence the definiteness of c T c anymore. Consider similarly the corresponding semi-contracting metric dynamics
d (5~TMS~) dt
=
_25~Tose;
(6.1o)
with positive semi-definite O = 0~ of T M 0f + 1VI. Factorizing O as - ' - + M~-~ v/-OTv/'O, say with a Cholesky factorization, and a similar a r g u m e n t a t i o n to the previous discussion allows to conclude on exponential convergence
6. Stability Analysis and Observer Design for Nonlinear Diffusion Processes of 115(~I[M : x/5OTMSO to zero for uniformly positive definite c T c
99
with
( L~ ) ---
Llv~
(6.11)
and the Lie derivatives LJv/'O(O, t)
Love6 = LJ+lv/o
--
of L J v / O ~-~ +
LJx/~
Vj > 0
This leads to the following definition and theorem D e f i n i t i o n 6.2 Given the globally analytic system equations ~ = f(O, t), a semi-contraction region of the state space is called a weak-contraction region with respect to the metric M(O,t), /.f c T c in (6.9) or c T ~ in (6.11) is uni.fozTnly positive definite in that region. T h e o r e m 6.3 Given the system equations (~ = f(O,t), any trajectory, which starts in a ball o.f constant radius with respect to the metric g ( o , t ) , centered at a given trajectory and contained at all times in a weak contraction region with respect to M ( ~ , t ) , remains in that ball and converges exponentially to this trajectory. Furthermore global exponential convergence to the given trajectory is guaranteed i.f the whole state space is a contraction region with respect to the metric M(O,t).
3
Nonlinear Diffusion Equations
We now extend and apply the above results to partial differential equations describing nonlinear reaction-diffusion processes. We shall use continuous state vectors 9 in Cartesian coordinates x, defined on a bounded m-dimensional region V. Bold characters will denote the continuous statespace quantities corresponding to pointwise terms. For instance, ~ will denote the state-space vector of components ~ t , and VkO the state-space vector of components Vkr Formally, 9 now lives on the Hilbert space L 2 (V), and differential length is defined by f v 5r so that the derivation of Section 2.1 extends immediately. F~rthermore, continuous state-space quantities can be computed as the limits of regularly discretized versions, as the discretization step tends to zero. For instance, on a one-dimensional continuum of length 1 5r
=
lira n---*+oo~ "
5r 5r i=1
100
6. Stability Analysis and Observer Design for Nonlinear Diffusion Processes
where the 5r are the discretized values. This limiting process will be our main c o m p u t a t i o n tool in assessing and quantifying the stability properties of the systems 9 Specifically, we first analyze the contraction properties of the V and V 2 operators. We then analyze and quantify the convergence rate of the nonlinear reaction-diffusion equation (6.1).
3.1
Contraction Properties of Reaction-Diffusion Processes
One-Dimensional V Operator Consider first the one-dimensional V operator on a one-dimensional continuum of length l, with given left and right b o u n d a r y conditions Cz (t) and Cr(t). We can write VO as the limit of an n • n discretization m a t r i x as
VO
n+l 21
lim
=
~k
-
.
-t-
1
0
0
.
-1
0
1
".
".
0
-1
".
"'.
0
0
".
".
0
1
0
-1
0
"' 9
~
o where Cz(t) and r Jacobian
0
'.
/
are the given left and right b o u n d a r y elements 9 T h e \
0VO 0O
-
n + 1 lim n-~+~ 2 l
0
1
0
0
".~
-1
0
1
".
".
0
-1
".
".
0
.
0
1
0
-1
0
0 "'.
9
.
"'.
.
(6.12)
is skew-symmetric, independently of Cz(t) and Cr(t). More generally, it is straightforward to show t h a t any odd derivative VkO, with k an odd positive integer, is skew-symmetric. One can easily show t h a t the result is unchanged if Vr (t) or V e t (t) are given instead 9
6. Stability Analysis and Observer Design for Nonlinear Diffusion Processes
101
One-Dimensional Laplace Operator Consider now the one-dimensional Laplace operator on the continuum, with given Ct(t) and r We can write [
(n + 1)2 V2~
=
lim
12
-2
1
0
0
.
1
-2
1
'.
.
0
1
'.
".
0
0
.
.
-2
1
.
0
1
-2
1
0
0
'.
1
-2
1
.
.
0
1
"'.
"'.
0
0
'.
'.
-2
1
"'.
"'.
0
1
0 0 +
4,+
0 0
The corresponding Jacobian is (-2 0V2O 00
-
lim (n+l) 2 ~-~+o~ l2
(6.13)
-2 )
whose largest eigenvalue is shown in the Appendix A to be upper bounded by - ~ . Thus, the one-dimensional Laplace operator ~720 with given boundary elements el(t) and r is contracting. Consider instead the Laplace operator with given boundary elements Cz(t) and V e t ( t ) along a continuum of length 1. By adding a mirror image of the system to the right we get a continuum of length 21 and given boundary elements Cz(t) and 7r 2 r Thus the largest eigenvalue of the Jacobian is now -2-~" If instead, Vr and v e t ( t ) are given on the left and right boundary, then in (6.13) the upper left and lower right corners become - 1 . A similar derivation in the Appendix A shows that the resulting matrix is only negative semidefinite, i.e. the resulting Laplacian is only semi-contracting. Note that this can be expected physically, since the system might simply converge to a specific 9 with a constant error over the continuum.
Multi-dimensional Laplace Operator Consider now an m-dimensional continuum, and the Laplacian
V2O =
Ox~ i=1
with boundary condition Cb(t), where the x~ are orthonormal Cartesian coordinates. Discretizing the region along any coordinate axis xi, similarly
102
6. Stability Analysis and Observer Design for Nonlinear Diffusion Processes
to the previous section, the largest eigenvalue of ~~
is at most -~,2~2 ....... ,
where l~,ma~ is the diameter (maximal thickness) of the region in the direction xi. Furthermore, since a discretization along any coordinate axis x~ can be transformed into a discretization along any other coordinate axis using an orthonormal coordinate transformation, the largest eigenvalue of rn the sum V 2 ~ = E i = I c92O is at most 27r2
m
=
-
l?
(6.14)
z,max
i:1
and thus the multi-dimensional Laplace operator V2O with given b o u n d a r y conditions Cb(t) is contracting. If instead VCb(t) is given on the whole boundary, then the Laplacian is only semi-contracting, with ~v~ = 0
(6.15)
E x a m p l e 3.1: Consider the Laplace operator in spherical coordinates 020 2 0~p 1 020 cosu 0~ 1 02~ V2(I, = ~ ++ + - + - r ~r r'~ ~ r 2 sin ~ cO, r 2 sin 2 , cO02 with angles 0, p, and radius r, and assume that Cb(t) is given on the sphere r = ro. The sphere's diameter is 2ro, so that the largest eigenvalue of this 3 ~v2 [] Laplacian is Av~ ------~-~,.
Reaction-Diffusion Equation Collecting the above results and using T h e o r e m 6.2 thus yields Theorem
6.4 Consider the reaction-diffusion equation
0r = h(t)V~r Ot
+ g(t)Vr
+ f(r
(6.16)
with h(t) a continuous and uniformly positive .function of time ( 3ho > O, Vt > O, h(t) >_ ho), and g(t) an arbitrary continuous .function of time. Assume that
h(t)
+
of
is uni.formly negative, where Av~ is given by equation (6.14) or (6.15) depending on the boundary conditions. Then, all system trajectories converge exponentially to a single trajectory ~Pd(x,t), with convergence rate Iho)~v2 + ~ ]. In the autonomous case ( f = f ( r h(t) =_ no, g(t) =_ go) and with constant boundary conditions, the system converges exponentially to a steady-state (I)d(X), which is the unique solution of the generalized Poisson equation 0 = ho V2r
+ go VCd + f(r
6. Stability Analysis and Observer Design for Nonlinear Diffusion Processes
103
T h e above development also implies t h a t all the results on c o n t r a c t i n g systems in (Lohmiller a n d Slotine [8]) can be e x t e n d e d to c o n t r a c t i n g reactiondiffusion processes, with b o u n d a r y conditions acting as additional i n p u t s to the system. For instance, any a u t o n o m o u s c o n t r a c t i n g reaction-diffusion process, w h e n subjected to b o u n d a r y conditions periodic in time, will t e n d exponentially to a periodic solution of the same period. T h e convergence is robust to b o u n d e d or linearly increasing disturbances. (e.g., in the form of a discretization of the c o n t i n u u m for simulation purposes). Also note t h a t the above result can be i m m e d i a t e l y e x t e n d e d to the case where the left-hand side of (6.16) is multiplied by a uniformly positive definite t e r m re(x), by using this t e r m as the metric.
3.2
Observer Design for Nonlinear Diffusion Processes
W h e n the nonlinear diffusion processes are n a t u r a l l y contracting, as described by the above theorem, observer designs b e y o n d merely copying the s y s t e m d y n a m i c s need only be selected to speed up the n a t u r a l c o n t r a c t i o n behavior of the system, as discussed in Section 2.2. In addition, b o u n d e d m e a s u r e m e n t disturbances in a contracting obsever design do not affect the c o n t r a c t i o n behavior, t h o u g h they m a y lead to a b o u n d e d offset in the limit behavior (Lohmiller and Slotine [8]). Finally, numerical implem e n t a t i o n s will discretize the continuum. T h e specific issues linked to this discretization will be discussed in Section 4. Let us now illustrate the design technique on a specific example, which also points out the possible role of b o u n d a r y conditions as a design tool, specific to observers for d i s t r i b u t e d systems. E x a m p l e 3.2: Consider a wafer disk of radius ro (Figure 2) subjected to continuous external light source, similarly e.g. to (Cho and Gyugyi [2]). The dynamic equations in radial coordinates 0 and r are (Groeber et al. [4])
= hV2T _ f (T 4 -- To4) with T > 0 the wafer temperature, To = 500 + 200 sin ~ K the external temperature, h = 1 m2/s a heat transfer constant, f = 10-SK-3s -1 a radiation constant, ro 20 cm, and boundary conditions ( OT )to = 0. According to Theorem 6.4, the system is naturally contracting with convergence rate 4 f T a. This means that an open-loop identity observer =
§
h 2r I
guarantees exponential convergence to T at the rate 4 f T a. The corresponding plant and observer response with initial conditions T(r,t = 0) = 500 + 200 cos 2,~_.._r.~K and T(r, t = 0) = 700 K are illustrated in Figure 3. For compurO tational simplicity the simulation exploits rotational symmetry in 0. Assume now that the actual temperature T(ro, t) is measfired at the boundary r = ro of the disk. Using this measurement as a boundary condition T(ro, t) increases
104
6. Stability Analysis and Observer Design for Nonlinear Diffusion Processes external racllatlon
//// rJ
X2
\\\\ external radiation FIGURE 2. Thermal processing of a wafer. the convergence rate to 4 f T 3 + h , according to Theorem 6.4, while at the same time preserving consistency with the actual plant (i.e., keeping the actual T as a particular solution of the observer equations with their boundary condition). The corresponding observer response with the same initial conditions as above is shown in Figure 4. []
4
Spatial Discretization and Numerical Implementation
This section briefly discusses some of the implications of t h e previous results for the numerical simulation of partial differential equations, which is of particular relevance in the context of observer i m p l e m e n t a t i o n . Let us spatially discretize equation (6.16) by a p p r o x i m a t i n g the c o n t i n u o u s s t a t e vector ~ with ~ ( O , x ) , where 9 is a finite-dimensional s t a t e vector. This discretization leads to an error e in e q u a t i o n (6.16) = h V 2 ~ + f ( ~ , x, t) + e
(6.17)
We can minimize e by requiring a00~ T e z 0 resulting in
M ~ = O---~-~T with M
--
(hv2
+ r)
ocTow Taking the variation of (6.17) a n d 6(-~Te) = 0 lead to 00 0r
1 d (SOTM~O)
TC~ff2To(hV2q2 + f) 0 ~
02/I/T
6. Stability Analysis and Observer Design for Nonlinear Diffusion Processes . . . -
Boo .... 'i .... i4oo looo
:
:
i
0
,
......
..-i ....... , ......
2oo~ 40
.
time t
0
0
105
'!"""
'--
....
i
'":
...,.
"'.
20
radius r
FIGURE 3. Wafer temperature as a function of time. This dynamics can be simplified using the largest eigenvalue Amax of 0q2 T O(hV2~+f/ (9~IJ with respect to M , and the m a x i m a l principal curvature 0,P o~ 0~
0"~,~T e - ~ M I = 0 I~lma= of qJ(O,x), obtained from det ]~-~~ d ( 6 o T M 6 ~ ) <_ (/~rnax Jr-Ile]] ]~],,~=)5'~TMSO a~ If we assume ~5 to be a minimal realization of ~, i.e. require M to be uniformly positive definite, then exponential convergence of 5r to zero implies exponential convergence of 6r to zero. T h e contraction behavior is hence unchanged in regions of small ]le]] ]~]max- This shows t h a t we have to approximate regions with large I~]ma= more precisely in order to preserve contraction.
5
Further Extensions
Besides actual reaction-diffusion or heat transfer processes, m a n y other distributed physical processes can be written as reaction-diffusion equations using a nonlinear coordinate transformation (Evans [3]). This is e.g. the case of the Burgers equation, used to model turbulent flows and shock waves, by applying the so-called Hopf-Cole transformation. Reaction-diffusion equations are also used as computing paradigms in other fields, such as machine vision. In this section, we briefly discuss some further extensions of the analysis, from which exponentially convergent observers could be similarly designed.
106
6. Stability Analysis and Observer Design for Nonlinear Diffusion Processes
9 ,oo
9 , .
=.J.
..-
b ,
- . ,
~
I--
4OO
. - o
,o~
~
,
, ,
, ,
o , ,
o ~ ~ I
, .=.~
9
.--
o*-"
9 . " ' ' ' i
, , ~ 1 7 6 1 7 6 ~
~176
.
. ..
,
.
"~ 200 E 0 3
20 time t
0
0
radius r
FIGURE 4. Estimation error of identity observer.
Nonlinear Functions of the Laplace Operator Consider now the system
0 r = h(V2r x, t) Ot with given boundary conditions Cb(t), where h is continuous function of its argument, differentiable and uniformly strictly monotonically increasing with respect to its first argument V2r The corresponding flmction h(V2qb, x, t) is a continuous state-space vector of elements h(V2r x, t), whose Jacobian is Oh Oh 0V2~ 0~ 0V2~ 0~ Oh Using the symmetric where ~ 0 h is a diagonal matrix of elements 0-'W~" positive definite Jacobian - ~ dynamics
as the metric leads to the virtual length
d -~
O~b
OVe~b O~b
The increase condition on h immediately implies that the system is contracting.
Wave Equation with Nonlinear Damping Consider now the wave equation re(x) 02r Ot2
V2r -
g(0__~r x , t ) - k(x)r (]b
6. Stability Analysis and Observer Design for Nonlinear Diffusion Processes
107
~ ,--
oo~"
,
'o
o~
.,.. ..,.
400
9
....
I-2.,
" ' ' ' ~ "
'
i i
'~ 200 ......
E
'
0 3 20
2
10 time t
0
0
radius r
FIGURE 5. Estimation error with temperature measurement at to. where all functions are assumed to be smooth, m and k are uniformly positive definite functions of x. and g is uniformly monotonically increasing in -ST" 0r The following virtual "energy" dynamics d
6(i)Tdiag(m ) 66 + 6(I}w diag(k)
60
2
(6.1s) guarantees semi-contraction behavior and hence bounded 5ep a n d 56. This implies t h a t any time-derivative of (6.18) is bounded since it can always be expressed as functions of 60 and 6q?. B a r b a l a t ' s l e m m a then implies a s y m p t o t i c convergence of 5r and 6(~ to zero. Veryfing the condition in T h e o r e m 6.3 even shows weak-contraction behavior i.e. t h a t the system is globally exponentially convergent.
Chains of Contracting Processes Chains of contracting processes are themselves contracting. More precisely, consider a smooth virtual dynamics of the form
dt
( ) (0. 502
=
o~1
of~ o~2
5~2
A uniformly negative definite os 04,t implies exponential convergence of 5~1 to zero. In turn, assuming t h a t ~OOl is bounded, o_f2_f 0(I'1 5Ol represents an exponentially decaying disturbance in the second equation, so t h a t a uniformly negative definite ~04~ implies exponential convergence of 5~2 to zero. T h e result extends by recursion to higher-order chains.
108
6. Stability Analysis and Observer Design for Nonlinear Diffusion Processes
E x a m p l e 5.1 : Consider the nuclear chain reaction U 9 223 s -t- n I
N
---*
U, 239 92 "~- "~
U9239 2
----+
~r 239 Ivp93 -~- e -
239 P93
"--*
n 239 Jr- C /-'U94
whose dynamics is, with reaction constants ki, diffusion constants hi, and bounded uniformly positive neutron input n~(t) _ U9238 2 U9239 2
N. 239
h
h
P93
~-2 r r23S I 1V t)92 -- /r
h 2 V~ 2 T ~029329
1TT238
, k 1~T238 ~. r r 2 3 9 -~- I n 0 u 9 2 -- n;2r
~-v2 ~ r 2 3 9 3V IYP93 t
~ rr239 ~g2u92
~ ~ 239 -- E31vP93
Since the output of a contracting process is bounded for bounded input, using the above reasoning recursively shows that the chain reaction is globally exponentially convergent. []
Nonlinear Schroedinger Equation Finally, the nonlinear Schroedinger equation
ih~t
= -h2v2r
+ V(r
can also be studied with only minor modifications, where h is the reduced Planck constant and m the mass. Defining squared length as 5q~T~ * (where 9 indicates complex conjugation), using h 2 0V2dP ihz
-
0V
2m
leads to (assuming that V(r x, t) is holomorphic in r
d'-~d((~T (~*) = (~T (~* ~- ~c~T(~* = -h2~r Im
(0V)_~_ 50*
In the linear case, the system is indifferent, a well-known result.
Acknowledgement The authors are grateful to Christophe Bernard for his help in computing the contraction rates in Appendix A.
6. Stability Analysis and Observer Design for Nonlinear Diffusion Processes 6
109
REFERENCES [1] V. I. Arnold. Mathematical Methods of Classical Mechanics, Springer Verlag, 1978. [2] Y. M. Cho and P. Gyugyi. Control of Rapid Thermal Processing: A System Theoretic Approach, LE.E.E. Transactions on control systems technology, 5(6), 1997. [3] L. C. Evans. Partial Differential Equations, American Mathematical Society, 1998. [4] H. Groeber, S. Erk and U. Grigull. Die Grundgesetze der Waermeuebertragung, Springer Verlag, 1988. [5] W. Hahn. Stability of motion, Springer Verlag, 1967. [6] N. N. Krasovskii. Problems o.f the Theory o.f Stability o.f Motion, Mir, Moskow, 1959. English translation by Stanford University Press, 1963. [7] P. Hartmann. Ordinary differential equations, second ed., Birkhauser, 1982. [8] W. Lohmiller and J. J. E. Slotine. On Contraction Analysis for Nonlinear Systems, Automatica, 3~(6), 1998. [9] D. Lovelockand H. Rund. Tensors, differential .forths, and variational principles, Dover, 1989.
[10] L. Schwartz. Analyse, Hermann, Paris, 1993.
Appendix A: Computation of Contraction Rates Let us compute an upper bound on the largest eigenvalue A of the n x n matrix
(n + 1) 2 12
2
-1
0
0
".
-1
2
-1
".
".
0
-1
.
.
0
0
".
".
2
-1
9.
".
0
-1
2
(6.19)
110
6. Stability Analysis and Observer Design for Nonlinear Diffusion Processes
as n --+ +cx~. Since ,k is the largest eigenvalue of (6.19), the n x n m a t r i x 2 - 2rl
-1
0
0
.
-1
2-2~/
-1
".
".
0
-I
"'.
"'.
0
0
.
.
2 - 27/
-1
".
"'.
0
-1
2-
(6.20)
2rl
l2 is positive semi-definite, where r/--- - 2-CKJTp" ~" Now the principal m i n o r s Ak of (6.20), which m u s t all be positive or zero, can be c o m p u t e d recursively
Ak = ( 2 - - 2r/)Ak_l -- A k - 2 with A 1 = 2 - 2 7 and A2 = (2 - 2r/): - 1. Noticing t h a t A1 _> 0 implies r/_< 1, this yields (1 . r / + V / (. 1
2V/(1 _ . ) 2
Thus, letting c o s a = l - ~ / one can write Ak =
( 1 - .- r/
1) k +.l
7) 2. -
Ak=
and s i n a =
V/(I -- ~/) 2
1) k+l
_ 1
X/I-(1-7/)
( c o s a + i s i n a ) k+l - ( c o s a - i s i n a ) k+l 2i sin a
2,with
0
~,
sin(k + 1 ) a sin
Thus, Ak _> 0 implies t h a t a < ~+1 , for any k > 1. This in t u r n implies that 7r 2 1-~?=cosa >1 -a2> 1(k + 1) 2 71.2
a n d thus t h a t 7/ _< ~W4-/V" As n --* + o o , the largest eigenvalue of (6.19) thus verifies AV2 = - lim 2 ( n + 1 ) 2 27r2 n--++oo l2 71 -< 12 In the simpler case of b o u n d a r y conditions in V@(t) a n d V e t ( t ) , the corresponding n • n m a t r i x is -1
1
0
0
.
1
-2
1
".
".
0
1
'.
'.
0
0
"'.
"'.
-2
1
0
1
-1
(n + 1) 2 12 .
.
".
".
6. Stability Analysis and Observer Design for Nonlinear Diffusion Processes To show t h a t this m a t r i x is n e g a t i v e s e m i - d e f i n i t e as n ~ to show t h a t 1
-1
0
0
.
-1
2
-1
".
".
0
-1
'.
'.
0
0
.
.
2
-1
~, ' .
'.
0
-1
1
111
+ o c it suffices
(6.21)
is p o s i t i v e semi-definite. C o m p u t i n g b y i n d u c t i o n t h e p r i n c i p a l m i n o r s A k of t h e a b o v e m a t r i x leads to A k = 1 for 1 < k < n - 1, a n d A n = 0, h e n c e t h e result. N o t e t h a t , a l t e r n a t i v e l y to this e x p l i c i t d e r i v a t i o n , s t a n d a r d r e s u l t s on eigenvalues of t h e L a p l a c i a n o p e r a t o r m a y also b e used, since t h e a s s o c i a t e d J a c o b i a n m a t r i x is itself s y m m e t r i c .
Nonlinear Passive Observer Design for Ships with Adaptive Wave Filtering Jann Peter Strand 1 and Thor I. Fossen 2 1ABB Industri AS Oslo, Norway 2Department of Engineering Cybernetics Norwegian University of Science and Technology Trondheim, Norway
1
Introduction
Dynamic positioning (DP) systems have been commercially available for marine vessels since the 1960's. DP systems are often installed on advanced ships like cable-layers, ice-breakers semi-submersible rigs and offshore supply vessels, for maintaining the horizontal position and orientation by use of the thrusters. See the recent paper by Sorensen, Sagatun and Fossen [15] for an overview of DP systems and references to earlier work. More recently positioning mooring (PM) systems has been developed. This is a control system for thruster assistance of moored structures. Such systems are important for safe operation of floating oil production, storage and offloading vessels (FPSO's) and semi-submersible rigs, which are moored to the seabed by an anchor system. Modeling and control system design of turret-moored ships is treated in Strand, Sorensen and Fossen [16]. Filtering and state estimation are important features of both DP and PM systems. In most cases, accurate measurements of the vessel velocities are not available. Hence, estimates of the velocities must be computed from noisy position and heading measurements through a state observer. Unfortunately, the position and heading measurements are corrupted with colored noise mainly caused by wind, waves and ocean currents. However, only the slowly-varying disturbances should be counteracted by the propulsion system whereas the oscillatory motion due to the waves (1st-order waveinduced disturbances) should not enter the feedback loop. This is done by using so-called wave filtering techniques, which separates the position and heading measurements into a low-frequency (LF) and a wave frequency (WF) position and heading part. The traditional Kalman filter-based estimators are linearized about a set of pre-defined constant yaw angles, typically 36 operating points in steps of 10 degrees, to cover the whole heading envelope between 0 and 360 degrees. When this estimator is used
114 7. Nonlinear Passive Observer Design for Ships with Adaptive Wave Filtering x
Y V (,!
x~.
X li ~' Y~:'
(Sltt i" ( y a w )
FIGURE 1. Reference frames (left) and definition of surge, sway and yaw modes of motion (right).
in conjunction with a linear (often linear quadratic) controller, there is no guarantee for global stability of the total system. In addition, linearization of the kinematic equations will naturally degrade the performance of the system. A nonlinear observer that can replace the traditional Kalman filter based designs was proposed by Fossen and Strand [6] for free-floating ships. This observer includes wave filtering and bias state estimation and it is proven to be GES, through a passivation design. Compared to the Kalman filter, the number of tuning parameters is significantly reduced and the tuning parameters are coupled more directly to the physics of the system. By using a nonlinear formulation, the software algorithms in a practical implementation are simplified. The observer of Fossen and Strand [6] has been applied by Aarset, Strand and Fossen [1], Strand and Fossen [17] and Loria, Fossen and Panteley [9] in output feedback controller design. Nonlinear observer designs for mechanical systems have been discussed by many. For instance, sliding observer designs for nonlinear systems is discussed by Slotine, Hendrick and Misawa [14]. Passivity and observer designs for mechanical systems are treated in Ortega, Loria, Nicklasson and Sira [13]. A similar problem to the ship positioning control is o u t p u t feedback control of robot manipulators, see e.g. Berghuis and Nijmeijer [2], Canudas de Wit, Fixot and Astrom [3], Nicosia and Womei [11], and Nicosia, Tornambe and Valigi [12]. In this paper nonlinear and adaptive observers for DP and P M systems are proposed. These are extensions of the nonlinear observer of Fossen and Strand [6]. The observers are proven to be passive and GES. An observer with adaptive wave filtering is derived, in order to adjust to slowly-varying sea states. The observers have been implemented and tested on a model ship and the results are reported. More details regarding nonlinear observer and controller designs for ships and experimental results can be found in Strand [18].
7. Nonlinear Passive Observer Design for Ships with Adaptive Wave Filtering
115
2 Modeling 2.1
Kinematics
Let the position (x, y) and the orientation (heading) ~ of the ship in the horizontal plane relative to an earth-fixed (EF) XEYEZE-frame be represented by the vector ~ = Ix, y, r An X Y Z - f r a m e is fixed to the vessel body, with the origin often located at the centre of gravity (CG), see Fig. 1. Body-fixed velocities are represented by the vector u = [u, v, r] T where u is the alongship velocity (surge), v is the athwartship velocity (sway) and r is the rotational velocity (yaw). A third frame, the so-called vessel parallel (VP) frame, specifies the desired position (Xd, Yd) and heading Cd of the ship relative to the XEYEZE-frame, and is represented by the vector ~d = [Xd, Yd, r T. In the design of tracking control systems, the reference vector is a smooth time varying signal ~d G C r, where the corresponding reference velocities in the body-fixed frame is Ud = [Ud, Vd, rd] T. T h e reference trajectories are generated by a separate reference generator. T h e linear velocities of the ship and the reference model in the body-fixed and in earth-fixed frames are related by the transformations:
i? = J(r
ild ---- J(r
(7.1)
where the rotation matrix in yaw J(a) : !t~ - - , ~}~3x3 is defined as:
J(a) =
cosa sin a 0
-sina cos a 0
0 ] 0 . 1
(7.2)
Note that J - l ( a ) = JT(a).
2.2
Vessel D y n a m i c s
In the m a t h e m a t i c a l modeling of ship dynamics, it is common to separate the model into a LF model and W F model. The W F motion of the ship is due tolst-order wave loads. The nonlinear LF equation of motion is driven by 2nd-order mean and slowly-varying wave, current and wind loads as well as thrust forces. In the case of moored ships, the restoring forces from the mooring system are treated as a function of the LF position and velocity of the ship. The total motion of the ship is given as the sum of the LF and the W F contributions, see Fig. 2.
Nonlinear Low-Frequency Model Both D P and P M systems are typical low-speed applications. In D P operations the ship will either follow a pre-defined track or maintain a fixed position and heading in the horizontal plane. In tracking operations the
116 7. Nonlinear Passive Observer Design for Ships with Adaptive Wave Filtering Low-frequency (LF) and wave-frequency (WF) motion
WF motion 0
o
~o
1(30
150
time
FIGURE 2. The total motion of a ship is modeled as a LF response with the WF response added as an output disturbance. speed of the reference velocities are small. In P M systems the mooring syst e m will naturally strongly limit the speed. W i t h low speed we m e a n speed in the range of 0 - 3 m/s. Under the assumption of low vessel speed, the following LF ship model is proposed (Fossen [5]):
Mi, + Du + JT(r
= Tthr + JT(~b)b.
(7.3)
Here Tthr C !}~a is a control vector of forces and m o m e n t provided by the propulsion system (thrusters). M C !t~ax3 is the inertia matrix including hydrodynamic added inertia, D E ~3x3 is a linear damping matrix, G E !t~3x3 is a stiffness matrix, due to a mooring system and b is a bias term, accounting for unmodelled external forces and moment. A symmetrical, spread mooring system is assumed, where we for simplicity have placed the earth-fixed frame in the natural equilibrium point of the mooring system. Further, we assume that G is a constant, diagonal matrix. For more details on mooring systems, see Faltinsen [4], Strand et al. [16] and Triantafyllou
[19]. Based on the low speed assumption, the following statements are made: P 1 M is constant and positive definite (Newman [10]):
M=MT>O
and 21}/=0.
(7.4)
P 2 The linear damping matrix D is strictly positive: D>0.
(7.5)
7. Nonlinear Passive Observer Design for Ships with Adaptive Wave Filtering
117
Linear Wave Frequency Model The W F motions are mainly generated by the 1st-order wave forces acting on the ship. Based on linear approximations of existing wave s p e c t r u m descriptions, see Fossen [5] for details, a linear W F model can be formulated as:
~
= A ~ + Ewww
(7.6a)
= C~,~
(7.6b)
where p is the order of the W F model, ~ E !Rap, w~ C ~3 is a zero-mean bounded disturbance vector and Aw, C~ and Ew are constant matrices of appropriate dimensions. The components of the W F motion is represented by the vector r/w = [xw,yw, ~bw]T. In one degree of freedom, this can for example be a 2nd-order d a m p e d oscillator (p = 2):
~{~} (s) = s2 + 2r
e~is
2 w{~i} + Woi
(i = 1, 2, 3)
(7.7)
where (.){,:} denotes the i-th vector element. Here (i is the relative d a m p i n g ratio and Woi is the natural frequency, which is related to the dominating wave frequency of the incoming waves. From a practical point of view, these are slowly varying quantities, depending on the sea state. Typically, the periods of the dominating waves are in the range of 5 to 20 seconds in the N o r t h Sea. In the case of a 2nd-order W F model the matrices in (7.6a)--(7.6b) are:
,]
-2af~
'C~:
[ 0 I ], E ~ =
[0] E~,2
where A = diag {~1, @, ~a}, = diag {Wol, wo~, Woa} , Evo2 = diag {ewl, ew2, ew3} .
(7.9) (7.10) (7.11)
Bias Modeling A frequently used bias model for marine control applications is:
= - T b l b + EbWb
(7.12)
where b E .~3, Wb C {R3 is a zero-mean bounded disturbance vector, Tb C ~axa is a diagonal m a t r i x of bias time constants and Eb a diagonal m a t r i x scaling the amplitude of Wb. T h e bias model accounts for slowly-varying forces and m o m e n t due to 2nd-order wave loads, ocean currents and wind.
118 7. Nonlinear Passive Observer Design for Ships with Adaptive Wave Filtering In addition, a bias model wilt account for errors in modeling of the constant mooring loads, actuator thrust losses and other unmodelled slowly-varying dynamics. Measurements
For conventional ships usually only position and heading measurements are available to the positioning system, whereas accurate velocity measurements are not available. Hence the measurement equation is written: y=v+~
+ vy
(7.13)
which consists of the LF and W F motions and measurement noise Vy c .~3.
2.3
Total Ship Model
When designing the observer, the following assumptions are made in the Lyapunov analysis regarding the ship model: A1
J(r ~ J(~ + r = J(r where Cy A r + r denotes the measured heading. This is a good assumption since the magnitude of the wave-induced yaw motion r will be less than 5 degrees in extreme weather situations and less than 1 degree during normal operation of the ship/rig.
A2
Position and heading sensor noise is omitted, vy = 0, since this noise is negligeable compared to the wave-induced motion.
F r o m Assumptions AI-A2 the total motion of moored and free-floating
ships is represented by the following equations: (7.14a)
= Aw~ + E w w w
(7.14b)
i] = J ( ~ y ) u = -T[-lb + Mi, = -Dr
y = ~+ ~
EbWb
- JT(r
= ~] + Cw~.
(7.14c) + JT(r
+ Tthr
(7.14d) (7.14e)
3 Non-Adaptive Observers Two different non-adaptive observers will be derived in this section. T h e first one is similar to the observer of Fossen and Strand [6] for dynamically positioned (free-floating) ships, where here also the effect of a spread mooring system is taken into account. In the second design, the observer is augmented by a new filtered state of the innovation signals. This adds
7. Nonlinear Passive Observer Design for Ships with Adaptive Wave Filtering
119
more flexibility to the observer design. By using feedback from the highpass filtered innovation in the W F part of the observer there will be no steady-state offsets in the W F estimates. Moreover, by using the low-pass filtered innovation in the bias estimation, these estimates will be less noisy and can thus be used directly as a feedforward t e r m in the control law. The adaptive observer proposed in Section 4 is based on the a u g m e n t e d observer. In the design we use an S P R - L y a p u n o v approach for obtaining passivity and stability of the observers. By including the synthetic wave model in the observer, wave-filtering is obtained, see Definition 1.
Wave .filtering can be defined as the reconstruction of the LF motion components .from noisy measurements o.f position and heading by means of an observer. In addition to this, noise.free estimates o.f the LF velocities should be produced. This is crucial in ship motion control systems since the W F part of the motion should n o t be compensated .for by the positioning system. If the W F part of the motion enters the .feedback loop, this will cause unnecessary tear and wear of the actuations and increase the .fuel consumption. D e f i n i t i o n 7.1 ( W a v e F i l t e r i n g )
3.1
O b s e r v e r in the E F f r a m e
The observer in this section is similar to the observer in [6], except t h a t the effect of a spread mooring system attached to the ship is included.
Observer Equations A nonlinear observer copying the ship-mooring dynamics (7.14a)-(7.14e) is: = A ~ + KI~)
;) = J ( r
+
b = --Tb-1/~ + K3y
M ~ = - D ~ - JT(fv)G~ ) + J T ( f v ) b + Tthr + JT(~y)K4~] 9 =
+
where ~ = y - ~) is the innovation vector and K1 E ~2.p• ~3• are observer gain matrices to be determined later.
(7.15a)
(7.15b) (7.15c) (7.15d) (7.15e) K2 ' K3 ' K4 C
Observer ET~ror Dynamics The estimation errors are defined as ~ = ~ - ~, ~ = ~ - ~), b = b - / ~ and = v - ~. Hence, from (7.14a)-(7.14e) and (7.15a)-(7.15e) the observer
120 7. Nonlinear Passive Observer Design for Ships with Adaptive Wave Filtering error dynamics is: :
A~
- KI~]
: fl(r
+
E~w~
(7.16a)
- K2y
(7.165)
: - T b l b - K3y + Ebwb M ~ : - O f , - JT(r
(7.16c)
+ jT(jy)~ _ jT(~y)K4~
9 = ~ + c~.
(7.16d)
(7.16e)
By defining a new output
50 A K4~I + G@ - b A Co,co
(7.17)
and the vectors
the error dynamics (7.16a)-(7.16d) can be written in compact form as:
M~, = - D e , - Jr(r
(7.19a)
)o = Ao?co + BoJ(~y)i, + EoW
(7.19b)
where
[ Aw-K1Cw Ao =
-I(l
0
-K2Cw
-K2
0
-K3Cw
-K3
--Tb 1
Co=[ K4C Bo =
I 0
, Eo:
4+C 0 0
] ,
-I], 0 Eb
.
Next the requirements on the observer gain matrices for stability and passivity of the observer error dynamics is provided.
Stability and Passivity By rewriting the observer error dynamics as (7.19a)--(7.19b) stability of the observer is provided by a SPR-Lyapunov design. The error dynamics is shown in Figure 3 where two new error terms ez and e , are defined as:
cz
A
-- flT(r
eu A J(r
(7.20)
Thus, the observer system consists of two linear blocks, interconnected through the bounded transformation matrix J(r Based on the physical properties of the ship dynamics, we can make the following statement:
7. Nonlinear Passive Observer Design for Ships with Adaptive Wave Filtering
121
FIGURE 3. Block diagram of the observer error dynamics.
P r o p o s i t i o n 7.1 The mapping Cz H 5 is state strictly passive and the block 7-ll in Fig. 3 is strictly passive. Proof. Let S1 ~--
I DTMD
(7.21)
be a positive definite storage .function. From (Z19a) we have: 1
: - - 2 i T ( D + DT)D + 5TE~
E'Tr >-- $1 + fl5 TE'
(7.22)
(7.23)
where fl ---- 1/~min(D q- D T) > 0 and/kmin(.) denotes the minimum eigenvalue. Thus, (7. 23) proves that cz ~-~ ~ is state strictly passive [8]. Moreover, since this mapping is strictly passive, post-multiplication with the bounded transformation matrix J(r and pre-multiplication by it's transpose will not affect the passivity properties. Hence the block Tll is strictly passive. [] Passivity and stability of the total system will be provided if the observer gain matrices K1, ..., K4 can be chosen such that the mapping c, ~-* So is passive. This is obtained if the matrices Ao, Bo, Co in (7.19a)--(7.19b) satisfies the KYP Lemma which is stated as below: L e m m a 7.1 ( K a l m a n - Y a k u b o v i c h - P o p o v ) Let Z ( s ) = C(81--J4)--1~ be a n x n transfer .function matrix, where .4 is Huvwitz, (.4,/~) is controllable, and (.4, C) is observable. Then, Z(s) is strictly positive real (SPR) if and
122 7. Nonlinear Passive Observer Design for Ships with Adaptive Wave Filtering only if there exist positive de.finite matrices P = p T and Q = Q T such that: "P*A + *ATT~ = _ Q,
13TJ i) = ft.
(7.24)
Proof: See e.g. Khalil [8]. []
Given a set of observer gains K1,...,/s the existence of the system to satisfy the KYP Lemma can be checked numerically by using the Frequency Theorem, originally formulated by Yakubovich [20], explicitly contained in Gelig, Leonov and Yakubovich [7]: T h e o r e m 7.1 ( F r e q u e n c y T h e o r e m )
Consider the system
= *Ax + 13u
(7.25a)
(7.25b)
y = CTx
where x E ,~n, u E ,~m, y E ,~m and,A, 13, C are real matrices of appropriate dimensions. Suppose the pair (*A,13) is stabilizable and det(jwI,~ - *A) ~ 0 Vw E !}~1. There exists a P : 7~T > 0 with
7) +*ATP < 0,
7~13+C = 0
(7.26)
i f the .following conditions
Re
( C T ( j w I n --
lirno w2Re (C T (jwIn -
,A) -1 13) < O, V~ E !}~1
(7.27)
*A)-I 13) < 0
(7.28)
hold. []
If the Frequency Theorem is satisfied for A = Ao, 13 = Bo, CT = - C o , the mapping c, H 4o (block ~2 in Fig. 3) is SPR and the observer error dynamics system is passive and GES as stated in the following: T h e o r e m 7.2 ( P a s s i v e O b s e r v e r ) The nonlinear observer (7.15a)-(7.15d) is passive. P r o o f . Since it is established that Tll is strictly passive and TI2 is SPR, the nonlinear observer is passive. [] T h e o r e m 7.3 (ISS a n d G E S O b s e r v e r ) The observer (7.15a)-(7.15d) with disturbance w is input-to-state stable (ISS). In addition, the observer error dynamics is rendered GES i.f we disregard the zero-mean disturbance, w~-O.
P r o o f . Consider the .following Lyapunov .function candidate: Vo =
+
7. Nonlinear Passive Observer Design for Ships with Adaptive Wave Filtering
123
Time differentiation of Vo along the trajectories of D and Xo yields: ~:o = - D T ( D + DT)D + Xo -T (PoAo + droPo) JCo + 2DTjT(r -- 2DT jT(r
(7.29)
+ 2~ToPoEow.
If the K Y P Lemma is satisfied .for the mapping e, ~ AoT 10o = - - Q o and BoT Po = Co, Vo can be written as:
zo, with PoAo +
17o = --DT(D + DT)D -- YcTQo&o + 2?cToPoEow.
(7.30)
From (7.30) it is seen that
~:o < O,
II~:o[I > 2
HQO1Eow[I
(7.31)
which shows that the observer is ISS. Moreover, in the disturbance free case, w =- O, the equilibrium point of the error dynamics is GES. []
Regarding the choice of observer gain matrices, the tuning procedure can be similar as for the observer for free-floating ships in Fossen and Strand [6]. Pole placement techniques can also be applied.
3.2 Augmented Observer The proposed observer in Section 3.1 can be further refined by augmenting a new state. The augmented design provides more flexibility and it is the basis for the adaptive observer in Section 4. We start by adding a new state, x i , in the observer, which is the low-pass filtered innovation ~: ~cI = - T f i x l
§ ~1= - T ? l x I
+ ~ + C~,~
(7.32)
where x I E !tP and T$ =diag{T$i,Ti2,T$3 } contains positive filter constants. High-pass filtered innovation signals can be derived from x I by:
~.f = - T f l x f + ~ = - T ? l x f -t- (] + Cw~
(7.33)
Thus, both the low-pass and high-pass filtered innovation is available for feedback. Moreover,
-
i+~I:'Y{O(S)T[: ~,{i}(s~ } , l+Tfis ~
\
(i = 1,2,3)
(7.34)
2
The cut-off frequency in the filters should be below the frequencies of the dominating waves in the WF model (7.6a)--(7.6b). Augmented Observer Equations
124 7. Nonlinear Passive Observer Design for Ships with Adaptive Wave Filtering The augmented observer is formulated as: = A~ + KlhYf
(7.35a)
= J(r163 + K2~ + K21xf -t- K2hYf
(7.35b)
= -Tb1~, + Ka9 + Ka~xl
(7.35c)
M~, = - D i - Jr(r
+ JT(r
+ Tthr (7.35d)
~_ jT(@y) (K4y ~- K41xj: -I- K4hYf)
9=~+c~
(7.35e)
where xy is the low-pass filtered innovation vector and Yl is the high-pass filtered innovation given by (7.32) and (7.33), respectively. Here Klh E ,~6x3 and K21, K2h, /(31, K41, K4h C ~3x3 are new observer gain matrices. Augmented Observer Error Dynamics
The augmented observer error dynamics can be written compactly as: (7.36a)
MP, = - D~, - J T (~py)Cj:a
(7.365)
~ca = AaS:a + B,,I(*py);' + Eaw
where
[
(7 7)
Za A_~K4~1 + K41xf + K4hYf -t- G~ -- b ~ Ca~ga,
(7.38)
and
Aa =
A~. - KlhCw - ( K 2 -~- K2h)Cw c~
-KaC~ 0 I 0 0
Ba =
Ca =
--Klh - ( K 2 -t- K2h) I -Ka Ea=
'
(K4 -t- K4h)Cw
0 0 0
Klhrf 1 K2fr) -1 - K21 -Kal
0 0 0 _Tb-1
0 0 0
Eb
(K4 -I- K4h) -F- G
- K 4 h T i I -t- K41
-i]
The signals Sf and x I are extracted from xa by Yl = ChiC. and xf = Cz2a where Cs--[C~
I-T~-'
Passivity and Stability
0],
Cz=[O
0
I
0].
(7.39)
7. Nonlinear Passive Observer Design for Ships with Adaptive Wave Filtering
125
Let Va = ~'TM ~ + YcTPaYca
(7.40)
be a Lyapunov function for the observer error dynamics (7..36a)--(7.36b). As before, the cross-terms of ~ and ~a in the expression for Va are cancelled by using an SPR-Lyapunov design, where it is required that: A T pa + PaAa -- - Q a ,
B T pa = Ca
(7.41)
The existence of a Pa = p T > 0, satisfying the KYP Lemma for the augmented observer error dynamics, can be tested numerically for a fixed set of observer gains by using the Frequency Theorem with 7~ = Pa, .4 = Aa, 13 = Ba, CT = - C a and u = e~. If so, the passivity and stability properties are similar as for the observer in Section 3.1 where: Va = --;'T(D + D T ) ; ' -- xTQaxa + 2y:TaPaE~w
(7.42)
and ~'a < 0,
[[Xa[I ~> 2 [[QalEaw[]
(7.43)
4 Adaptive Observer In this section we treat the problem when the parameters of Aw in the W F model (7.6a) are not known. The parameters vary with the different sea-states in which the ship is operating. Gain-scheduling techniques, using off-line frequency trackers and external sensors such as wind velocity and wave radars can be used to adjust to the W F model to varying sea states. However, this can be circumvented by using an adaptive observer design. Since the wave models are decoupled, A and ~ in A~ are diagonal matrices, and we have: A~o(0~)= [
0 _~2
T
I ] ~ [ 0 -2A~ = -diag(0~l)
I ] -diag(0w2)
(7.44)
S}~3
where 0~ = [0~1, T 0~2 ] , 0wl, 0~2 E , contains the unknown wave model parameters to be estimated. We start with the following assumption: A3
( C o n s t a n t e n v i r o n m e n t a l p a r a m e t e r s ) . It is assumed that the unknown parameters ~ and A in the W F model (7.7) are slowly varying and within the range of
0 <00J~~min"~<02~<<~maxw~ } ,
i = 1, 2, 3
(7.45)
such that A~ is Hurwitz. Hence, the unknown wave model parameters are treated as constants in the analysis, such that b~ = 0
(7.46)
126 7. Nonlinear Passive Observer Design for Ships with Adaptive Wave Filtering
~.1
Adaptive Observer Equations
The adaptive version of the observer is equal to the augmented observer (7.35a)-(7.35e), except from the W F part which is now using the estimated W F parameters, 0~, such that: ~.
^
^
= A~(O~)~ + Klh~lf.
(7.47a)
The adaptive update law for 0~ remains to be decided.
4.2
Adaptive Observer Error D y n a m i c s
The adaptive W F observer error dynamics is:
= A ~ - Aw(O~)~ - KlhYf + E~w~
(7.48)
By adding and subtracting A ~ , defining BwT~(~)0~ = (A~ - A~(t~))~
(7.49)
where 0~ : (~ - 0~ denotes the estimation error, T
^
A
T~(~) : [ diag(~l)
diag(~2) ],
(7.50)
I
(7.51)
where ~ = [~T, ~T]T, ~1, ~2 9 !}~3, and by using (7.33) then (7.48) can be rewritten as: (dw - KlfCw)~
- Klf?)
r
^
+ BwTw(~)Ow
+ K l f T ~ l x i + E~w~
(7.52)
The observer error dynamics can be written compactly as:
M~ -- - D 5
(7.53a)
- J T (~y)Ca~c a
2a = Aj:~ + B~J(r
+ HaT~(~)O~ T ^ - + E~w
(7.535)
where
Ha= [ 4.3
0 0 0
(7.54)
Stability and Passivity
Let -T w - - 1 Ow ~ Vad ---- DT M 5 + s:T p a ~ a + OwE
(7.55)
7. Nonlinear Passive Observer Design for Ships with Adaptive Wave Filtering
127
be a Lyapunov function for the observer error dynamics (7.53a)--(7.53b), where F~ -- F T > 0 C .~}~6x6 is an adaptive update gain matrix. Thus:
l~rad : __~,T(D + DT)F] _ 2 F ] T f l T ( r nt- 2 ~ T j T ( r
a ~ _ x a ( m a PTa . . . i .
PaAa):~a
a + 20wTw(~)g2 -T ^ T PaXa -
+ 2SaPaEaw + 20Tr-lb~
(7.56)
In the adaptive case, we want the W F adaptive law to be u p d a t e d by the high-pass filtered innovations signals9 Hence, it is required that:
ATpa + PaAa = - Q a
(7.57a)
BTaPa = Ca
(7.57b)
HT p~ = Ch
(7.57c)
The existence of a Pa = p T > 0 that satisfies (7.57a)-(7.57c) can be tested numerically by using the Frequency Theorem with 7 ~ = P , , .4 = Aa, U = [gT,-T 0~] T and B=[
Ba
Ha ]
=-
[ Ca
"
(7.58)
Since there exists a solution, the expression for l)~d becomes: I)ad = --YcTQaY:a -- DT(D + DT)D -1- 2ycTpaEaW -T ^ ~ + 20wr~ ~T - 1 0~ "+ 20,~T,~(~)Chz,
(7.59)
which suggests that the adaptive update law should be:
Ow o,,,,--o b~ = - r w T ~ ( ~ ) C h 2 a = - F ~ T ~ ( ~ ) ~ I
(7.60)
V~d = --YcTQaYca -- ~'T(D + DT) ;' + 2s:TpaEa w
(7.61)
Thus,
and error dynamics of the adaptive observer is:
M~, = -OF, - JT(r Yca= A j c a + BaJ(r 9
= -FwT~(~)Chia
(7.62a)
+ HaTw(~)0w + Eaw T
^
~
(7.625) (7.62c)
From (7.61) we see that the system is ISS. If the ship is exposed to W F motions, the system will be P E and 0w --* O~.
128 7. Nonlinear Passive Observer Design for Ships with Adaptive Wave Filtering Basin
wi~r X, Y
wave generator
FIGURE 4. Left: Experimental setup. Right: Picture of Cybership I.
5
Experimental Results
Both the augmented and the adaptive observer have been implemented and tested at the Guidance, Navigation and Control (GNC) Laboratory, D e p a r t m e n t of Engineering Cybernetics at the Norwegian University of Science and Technology (NTNU). We have used Cybership I, a model ship of scale 1:70, see Fig. 4. A nonlinear P I D controller is used for maintaining the ship at the desired position ( X d , Yd) and heading ~d- The P I D control law is written: Tc = - - M J T ( r
-- Cd)
(
K p e ~- K d e -~ K i
/0 ) e d~
(7.63)
where e is the estimated LF position deviation, defined as: e ~- J T ( r
- - ~?d)
(7.64)
An illustration of the experimental setup is given in Fig. 4. The experimental results are scaled to full scale by requiring that the F r o u d e n u m b e r Fn
U
-- - -
--
constant,
(7.65)
where U is the vessel speed, L is the length of the ship and g is the acceleration of gravity. The scaling factors are given in Table 7.1 where m is the mass and the subscripts m and s denote the model and the full-scale ship, respectively. The length of the model ship is L m : 1.19 m and the mass is mm = 17.6 kg. A full scale ship similar to Cybership I has typically a length of 70-90 meters and mass of 4000-5000 tones. In the scaling we used Ls = 70Lm meters and ms = 4500 tones.
7. Nonlinear Passive Observer Design for Ships with Adaptive Wave Filtering I position:
129
Ls/Lm
I linear velocity: I angular velocity: I linear acceleration:
1
I angular acceleration:
L,~/Ls
I force:
ms/' m
I moment:
m,~L,~
rn.~ L m
I time: TABLE 7.1. Scaling factors used in the experiments (Bis scaling).
The experiment was performed in three phases:
9 Phase I (No waves). Initially the ship is maintaining the desired position and heading with no environmental loads acting on the ship (calm water). When the data acquisition starts, a wind fan is switched on. There is no adaptive wave filtering and the observer is identical to the augmented design in Section 3.2. The effect of the wind loads are reflected in the bias estimates in Fig. 6. 9 Phase II (Waves, adaptive wave .filter off). After 1700 seconds the wave generator is started. In this phase we can see the performance of the observer without adaptive wave filter. In the wake model we are assuming that the dominating wave period is 9.2 seconds and the relative damping is 0.1, see Fig. 5. 9 Phase III (Waves, adaptive wave .filter on). After 2800 seconds the adaptive wave filter is activated. The estimates of dominating wave period and relative damping are plotted in Fig. 5 for surge, sway and yaw. A spectrum analysis of the position and heading measurements shows that the estimated wave periods converge to the true values, that is wave periods of approximately 7.8 seconds and relative damping ratios of 0.07, see Fig. 5. In Fig. 6 the measured position deviation and heading are plotted together with the corresponding LF estimates. The effect of the adaptive wave filtering is clearly seen in Fig. 8, where the innovation signals are significantly reduced in Phase III, when the adaptation is active and the wave model parameters start converging to their true values. The effect of bad wave filtering is reflected by noisy control action by the thrusters in phase II, see Fig. 8. A zoom-in of the heading measurement together with the LF estimate is given is Fig. 7 both for phase II and III. Here we see that the LF estimates have a significant W F contribution when the adaptive wave filter
130 7. Nonlinear Passive Observer Design for Ships with Adaptive Wave Filtering Estimated wave periods [see]
Estimated relative damping ratios [-]
9.5
0.3
8.5
o2
7.5
"~
9
7 ...r.~..~.~?.................
....~..:~.~:................
,~ o
6.5 I000
<
I
2000
F~
3000
11 ~ time [sec]
4000
II1
5000
lO00
I
2000
II
3000
~" time [see]
4000
5000
111
FIGURE 5. Estimated wave periods (left) and estimated relative damping ratios (right) for surge (solid), sway (dashed) and yaw (dashed). The adaptive wave-filter is activated after 2800 seconds.
is off. This is the reason for the noisy control action in phase II. T h e other zoom-in shows excellent LF estimation when the adaptive wave filter is active and the wave model parameters have converged to their true values. Hence, it can be concluded that adaptive wave filtering yields a significant improvement in performance compared to a filter with fixed p a r a m e t e r s and varying sea states.
6
Conclusions
In this paper we have derived a nonlinear passive observer for m o o r e d and free-floating ships. By adding low- and high-pass filtered innovation signals in the design, we have additional flexibility in the design. This a u g m e n t e d design is extended to a new observer with adaptive wave filtering. Experiments with a model ship shows that the adaptive observer will significantly improve the performance of the ship positioning system. This results in reduced magnitude of the observer innovation, better filtering properties and reduced control action by the propulsion system.
ACKNOWNLEDGEMENTS T h e authors are grateful to Dr. Anton Shiriaev, Dept. of Eng. Cybernetics, N T N U , for valuable discussions on passivity and frequency domain m e t h ods. This work is sponsored by the Research Council of Norway and ABB Industri AS.
7. Nonlinear Passive Observer Design for Ships with Adaptive Wave Filtering
131
Estimated bias in surge [kNI
Measured (grayl aJld estimated LF (solid) x-posilioiL deviation [m]
0 -10 -20 -30 -40 -50 -60 -70
-3
-80 -90 1000 Measured r
2O00
30OO
4O0O
50O0
and estinlated LF (solid) y-p~Jsition deviation [nil
1~
2000
3000
4000
Estimated bias in sway IkN I
20OO
tO(O)
5000
Maurcd(graveslimatcdLFtsolidanadcsireddt)tledheJdi.nldeg]
3000
4000
Estimated bias in yaw [kNm] 0
-136
-200
-138
-400
-140 -142 -800
-1441
-ICO(
-146 1000
<
2000
3000
>< 1
4000
5000
><
>
II time [see]
0
1c00
<
Ill
200o
300o
~-< I
4000
5000
><
>
It
III time [see]
F I G U R E 6. Left column: Measured position and heading together with corresponding LF estimates. Right column: Estimated bias in surge, sway and yaw.
Z o o m - I n : Measured (dotted) and estimated LF (solid) heading (dashed)
I l L Adaptive W a v e - F i l t e r On
11: Adapti;'e Wave-Filter Off -135
-135
-136
-136 -137
...
I :"
" "~
.4 ""
,: --
.t.
~.
-137
'.
-138
-138
-139
-139 -140
-140
-141
-141 -142
"'
'~V
-142
-143
-143
-144
-144
-145 2300
Ldeg]
2320
2340
2360
t i m e [sec]
2380
2400
-145 4900
VVVVVV JVVVVV 4920
4940
4960
4980
tirae [see]
F I G U R E 7. Zoom-in of measured and estimated LF heading. Left: Observer without adaptive wave-filtering. Right: Observer with adaptive wave-filtering.
5000
132 7. Nonlinear Passive Observer Design for Ships with Adaptive Wave Filtering
~
Innovation in x..~e,~ou [m]
thrust in sm'sc
80 70 60 5O 40 30 20 10 0 -10
Innov~
I000
in y-d~-~on Ira]
2000
30~0
~
5000
Commmsded~a'u~ m ~wry Dr~rJ
0.8
180
0.6
160 140
0.4
1:20
0.2
I00 0
80
-0.2
60
-.0.4
~0
-0.6
20
-0.8
0
zm~o-~tionin ~
[~ld
C~,,,m,,,~d tt~umin ~
[Sdqm]
0.8 1400
0.6
1200
0.4
1000
0,2
8OO 0
6OO
-0.2
4OO
-0.4
200
-0.6
0
-0.8
1000
I
2000
3000
I!
4000
Ill
5000
-2OO
1000
< [
2000
II
~00
4000
~00
III
F I G U R E 8. Left column: Innovation in position and heading. Right column: Commanded thrust in surge, sway and yaw.
7. Nonlinear Passive Observer Design for Ships with Adaptive Wave Filtering 7
133
REFERENCES [1] M. F. Aarset, J. P. Strand and T. I. Fossen. Nonlinear Vectorial Observer Backstepping With Integral Action and Wave Filtering for Ships. Proc. of the IFAC Conference on Control Applications in Marine Systems (CAMS'98), Fukuoka, Japan, 1998, pp. 83-89, 1998. [2] H. Berghuis and H. Nijmeijer. A Passivity Approach to ControllerObserver Design for Robots. IEEE Trans. on Robotics and Automation, RA-8(6):740-754, 1993. [3] C. Canudas de Wit, N. Fixot and K. J. Astrom. Trajectory Tracking in Robot Manipulators via Nonlinear Estimated State Feedback. IEEE Trans. on Robotics and Automation, RA-8:138-144, 1992. [4] O. M. Faltinsen. Sea Loads on Ships and Offshore Structures. Cambridge University Press, 1990. [5] T. I. Fossen. Guidance and Control of Ocean Vehicles. John Wiley & Sons Ltd, 1994.
[6] T. I. Fossen and J. P. Strand. Passive Nonlinear Observer Design for Ships Using Lyapunov Methods: Full-Scale Experiments With a Supply Vessel. Automatica. AUT-35(1)3-16, 1999. [7] A. H. Gelig, G. A. Leonov and V. A. Yakubovich. Stability of Nonlinear Systems with Unique Stationary Points. Nauka. Moscow, 1978. [8] H. K. Khalil. Nonlinear Systems. Prentice Hall Inc., 1996. [9] A. Loria, T. I. Fossen and E. Panteley. A Cascaded Approach to a Separation Principle for Dynamic Ship Positioning. IEEE Trans. on Control Systems Technology (submitted). [10] J. N. Newman. Marine Hydrodynamics. MIT Press. Cambridge, Massachusetts, 1977. [11] S. Nicosia and P. Tomei. Robot Control by Using only Joint Position Measurements. IEEE Trans. Automat. Contr., AC-35:1058-1061, 1990. [12] S. Nicosia, A. Tornambe and P. Valigi. Experimental Results in State Estimation of Industrial Robots. Proc. Conf. Decision and Control, Honolulu, HI, Dec. 1990, pp. 360-365, 1990. [131 R. Ortega, A. Loria, P. Nicklasson and H. Sira. Passivity-Based Control of Euler-Lagrange systems. Springer-Verlag, 1998. [14] J. J.-E. Slotine, J. K. Hedrick and E. A. Misawa. Sliding Observers for Nonlinear Systems. ASME J. Dynam. Syst., Measurement, Control, Vol. 109, pp. 245-252, 1987.
134 7. Nonlinear Passive Observer Design for Ships with Adaptive Wave Filtering [15] A. J. Scrensen, S. I. Sagatun and T. I. Fossen. Design of a Dynamic Positioning System Using Model-Based Control. Journal of Control Engineering Practice. CEP-4(3):359-368, 1996. [16] J. P. Strand, A. J. Scrensen and T. I. Fossen. Design of Automatic Thruster Assisted Position Mooring Systems for Ships. Modeling, Identification and Control, MIC-19(2):61-75, 1998. [17] J. P. Strand and Thor I. Fossen. Nonlinear Output Feedback and Locally Optimal Control of Dynamically Positioned Ships: Experimental Results. Proc. of the IFAC Conf. on Control Applications in Marine Systems (CAMS'98), Fukuoka, Japan, pp. 89-95, 1998. [18] J. P. Strand. Nonlinear Position Control Systems Design for Marine Vessels. Doctoral Dissertation. Department of Engineering Cybernetics, NTNU, Trondheim, Norway, 1999. [19] M. S. Triantafyllou. Cable Mechanics for Moored Floating Systems. BOSS'94 pp.67-77, Boston, MA, 1994. [20] V. A. Yakubovich. A Frequency Theorem in Control Theory. Siberian Mathematical Journal SMJ-14(2):384-420, 1973.
Nonlinear Observer Design for Integration of D G P S and INS Bjornar Vik, Anton Shiriaev and Thor I. Fossen D e p a r t m e n t of Engineering Cybernetics Norwegian University of Science and Technology N-7034 Trondheim, Norway
1
Introduction
This section contains the notation used in this chapter and the main motivation for the work with references to previous research.
1.1
Nomenclature
In the rest of this chapter, we will use the notation: w~ b ~ ~3
:
v a E !}~3
: : :
a~ ~ so(3)
Angular velocity of frame a relative to frame b, decomposed in frame c. Linear velocity decomposed in frame a. 3 • 3 skew-symmetric