Observability and observer design for switched linear systems

Hybrid vehicles, HVAC systems in new/old buildings, power networks, and the like require safe, robust control that includes switching the mode of operation to meet environmental and performance objectives. Such switched systems consist of a set of continuous-time dynamical behaviors whose sequence of operational modes is driven by an underlying decision process. This thesis investigates feasibility conditions and a methodology for state and mode reconstruction given input-output measurements (not including mode sequence). An application herein considers insulation failures in permanent magnet synchronous machines (PMSMs) used in heavy hybrid vehicles. Leveraging the feasibility literature for switched linear time-invariant systems, this thesis introduces two additional feasibility results: 1) detecting switches from safe modes into failure modes and 2) state and mode estimation for switched linear time-varying systems. This thesis also addresses the robust observability problem of computing the smallest structured perturbations to system matrices that causes observer infeasibility (with respect to the Frobenius norm). This robustness framework is sufficiently general to solve related robustness problems including controllability, stabilizability, and detectability. Having established feasibility, real-time observer reconstruction of the state and mode sequence becomes possible. We propose the embedded moving horizon observer (EMHO), which re-poses the reconstruction as an optimization using an embedded state model which relaxes the range of the mode sequence estimates into a continuous space. Optimal state and mode estimates minimize an L2-norm between the measured output and estimated output of the associated embedded state model. Necessary conditions for observer convergence are developed. The EMHO is adapted to solve the surface PMSM fault detection problem

Recent Advances in Robust Control

Robust control has been a topic of active research in the last three decades culminating in H_2/H_\infty and \mu design methods followed by research on parametric robustness, initially motivated by Kharitonov's theorem, the extension to non-linear time delay systems, and other more recent methods. The two volumes of Recent Advances in Robust Control give a selective overview of recent theoretical developments and present selected application examples. The volumes comprise 39 contributions covering various theoretical aspects as well as different application areas. The first volume covers selected problems in the theory of robust control and its application to robotic and electromechanical systems. The second volume is dedicated to special topics in robust control and problem specific solutions. Recent Advances in Robust Control will be a valuable reference for those interested in the recent theoretical advances and for researchers working in the broad field of robotics and mechatronics

UAV perception for safe flight under physical interaction

Aplicat embargament des de la data de defensa fins al maig 2020The control of autonomous flying vehicles with navigation purposes is a challenging task. Complexity arises mainly due to the non-linearity and uncertainty inherently present in the flight mechanics and aircraft-air interactions. Recently, interest has grown for equipping unmanned vehicles with the capacity to interact with their environment, other vehicles or humans. This will enable interesting applications such as autonomous load carrying, aerial refueling or parcel delivering. Having measured the interaction wrenches ease the control problem which can be configured to reject disturbances or to take profit of them to fulfill mission objectives. This thesis will contribute to this area by providing perception solutions which use limited and low cost sensors that enable state and disturbance estimation for possible, but not restricted to, interaction scenarios. This thesis contain three parts. The first part, introduces basic concepts related to the navigation state, aircraft dynamics, and sensor models. In addition, the platform under study is presented and mathematical models associated to it are calibrated. The second part is devoted to the observability analysis and the design of state observers. Linear and non-linear observability analysis techniques are used to unveil that the state of quadrotors equipped with GPS, magnetometers an IMU sensors cannot be uniquely identified in some specific flight configurations. Results of this section are relevant because the conflicting flight configurations contain hover, a flight maneuverer central in many unmanned aerial missions of VtoL vehicles. For many possible singular configurations, insightful descriptions and interpretations of the solution space known as indistinguishable region is provided. Findings are verified in simulation scenarios where it can be seen how a filter fails to recover the true state of an aircraft when imposing the hover flight condition. We discuss then the design of Extended Kalman Filters for state estimation that considers the available sensors. Issues that are typically not reported in the literature, such as when to update or propagate in the estimator algorithm or which coordinate frame should be used to represent each state variable are discussed. This leads to the formulation of four potentially equivalent but different discrete event-based filters for which precise algorithmic expressions are given. We compare the results of the four filters in simulation under known favorable conditions for observability. In order to diminish the effect of flying in the conflicting observability configurations, we provide an alternative filter based on the Schmidt Kalman Filter (SKF). The proposed filter shares the structure of the EKF, behaves better in the instants that the EKF fails and provides similar results in the remaining conditions. The last part of the thesis deals with the estimation of external disturbances. Disturbance estimation results are based on the derivation of a linear model for the aircraft dynamics which then extended with a high order disturbance model to enable the estimation of fast varying disturbances. Two external disturbance estimators from the literature are reviewed and adapted to the new model. Also, two Kalman observers that exploit the linearity of the derived model are presented. A simulation comparison is provided demonstrating that the KF disturbance estimators outperform the other. In addition, this part presents a design methodology of generic quadratic bounded observers for linear systems with ellipsoidal bounded uncertainty. The derived observers maximize a user tunable compromise between the estimation convergence speed and the final volume containing the estimation error. An observer for disturbances acting on a flying platform is derived considering the high order disturbance model above mentioned. Finally, an analysis of the estimation performance with respect to the design parameters is presented.Esta tesis, contribuye en este área formulando soluciones de percepción que permiten la estimación del estado y perturbaciones externas en condiciones normales de vuelos así como casos de interacción para UAVs equipados con sensores limitados y de bajo coste. La tesis se estructura en tres partes. La primera de ellas introduce los conceptos básicos relacionados con el estado de navegación, la dinámica de la aeronave y modelos de sensores. Además, se presenta la plataforma de estudio así como los modelos matemáticos asociados a ella y su calibración. La segunda parte está destinada al análisis de observabilidad y el diseño de observadores de estado. Los resultados de esta sección son importantes porque dentro de las condiciones de vuelo conflictivas se encuentra el vuelo a punto fijo, una maniobra de vuelo central en muchas misiones de vehículos VToL. Se analizan estas condiciones críticas de vuelo y para ellas se deriva y describe el espacio de soluciones posible conocido como región indistinguible. Los resultados son verificados en simulación dónde se puede apreciar como un estimador de estado falla al intentar realizar su tarea cuando la aeronave está en vuelo a punto fijo. Seguidamente se presenta el diseño de filtros extendidos de Kalman (EKF) que proveen estimaciones del estado con la información limitada de los sensores disponibles. Se discuten conceptos que habitualmente no se presentan en la literatura como cuando actualizar o propagar en el algoritmo de estimación o que sistema de referencia se debe utilizar para representar adecuadamente las variables de estado. Esto lleva a la formulación algorítmica de cuatro filtros discretos basados en eventos, diferentes, pero en esencia equivalentes. Se derivan rutinas de inicialización para los filtros y se comparan los resultados en simulación bajo condiciones favorables de estimación. Con la idea de disminuir el efecto de volar en configuraciones de observabilidad conflictivas, se deriva un filtro alternativo basado en el filtro de Schmidt Kalman (SKF). El filtro propuesto comparte estructura con el EKF, tiene un mejor comportamiento allí dónde le EKF falla y una respuesta similar en el resto de condiciones de vuelo. La última parte de la tesis trata con la estimación de perturbaciones externas. Para ello se deriva un modelo lineal que relaciona fuerzas y momentos con velocidades junto a un modelo de alto orden para las perturbaciones. Se estudia su aplicación a dos modelos para la estimación de perturbaciones ya presentes en la literatura. Además, se proponen dos nuevos filtros de Kalman que se aprovechan de la linealidad del modelo. Se presenta una comparativa basada en la simulación de escenarios ideales así como realistas que demuestra que los filtros KF superan al resto. Esta misma parte de la tesis presenta el diseño genérico de estimadores "quadratic bounded" para sistemas dinámicos lineales cuya incertidumbre se encuentra acotada dentro de elipsoides. Estos estimadores maximizan un compromiso, ajustable por el usuario que contempla la velocidad de convergencia así como el volumen de la solución final que contiene el error de estimación. Se deriva un observador de perturbaciones para plataformas aéreas basado en el modelo de alto orden arriba mencionado. Finalmente, se presenta un análisis del desempeño de estimación en función de los parámetros de diseño del filtro.Postprint (published version

UAV perception for safe flight under physical interaction

The control of autonomous flying vehicles with navigation purposes is a challenging task. Complexity arises mainly due to the non-linearity and uncertainty inherently present in the flight mechanics and aircraft-air interactions. Recently, interest has grown for equipping unmanned vehicles with the capacity to interact with their environment, other vehicles or humans. This will enable interesting applications such as autonomous load carrying, aerial refueling or parcel delivering. Having measured the interaction wrenches ease the control problem which can be configured to reject disturbances or to take profit of them to fulfill mission objectives. This thesis will contribute to this area by providing perception solutions which use limited and low cost sensors that enable state and disturbance estimation for possible, but not restricted to, interaction scenarios. This thesis contain three parts. The first part, introduces basic concepts related to the navigation state, aircraft dynamics, and sensor models. In addition, the platform under study is presented and mathematical models associated to it are calibrated. The second part is devoted to the observability analysis and the design of state observers. Linear and non-linear observability analysis techniques are used to unveil that the state of quadrotors equipped with GPS, magnetometers an IMU sensors cannot be uniquely identified in some specific flight configurations. Results of this section are relevant because the conflicting flight configurations contain hover, a flight maneuverer central in many unmanned aerial missions of VtoL vehicles. For many possible singular configurations, insightful descriptions and interpretations of the solution space known as indistinguishable region is provided. Findings are verified in simulation scenarios where it can be seen how a filter fails to recover the true state of an aircraft when imposing the hover flight condition. We discuss then the design of Extended Kalman Filters for state estimation that considers the available sensors. Issues that are typically not reported in the literature, such as when to update or propagate in the estimator algorithm or which coordinate frame should be used to represent each state variable are discussed. This leads to the formulation of four potentially equivalent but different discrete event-based filters for which precise algorithmic expressions are given. We compare the results of the four filters in simulation under known favorable conditions for observability. In order to diminish the effect of flying in the conflicting observability configurations, we provide an alternative filter based on the Schmidt Kalman Filter (SKF). The proposed filter shares the structure of the EKF, behaves better in the instants that the EKF fails and provides similar results in the remaining conditions. The last part of the thesis deals with the estimation of external disturbances. Disturbance estimation results are based on the derivation of a linear model for the aircraft dynamics which then extended with a high order disturbance model to enable the estimation of fast varying disturbances. Two external disturbance estimators from the literature are reviewed and adapted to the new model. Also, two Kalman observers that exploit the linearity of the derived model are presented. A simulation comparison is provided demonstrating that the KF disturbance estimators outperform the other. In addition, this part presents a design methodology of generic quadratic bounded observers for linear systems with ellipsoidal bounded uncertainty. The derived observers maximize a user tunable compromise between the estimation convergence speed and the final volume containing the estimation error. An observer for disturbances acting on a flying platform is derived considering the high order disturbance model above mentioned. Finally, an analysis of the estimation performance with respect to the design parameters is presented.Esta tesis, contribuye en este área formulando soluciones de percepción que permiten la estimación del estado y perturbaciones externas en condiciones normales de vuelos así como casos de interacción para UAVs equipados con sensores limitados y de bajo coste. La tesis se estructura en tres partes. La primera de ellas introduce los conceptos básicos relacionados con el estado de navegación, la dinámica de la aeronave y modelos de sensores. Además, se presenta la plataforma de estudio así como los modelos matemáticos asociados a ella y su calibración. La segunda parte está destinada al análisis de observabilidad y el diseño de observadores de estado. Los resultados de esta sección son importantes porque dentro de las condiciones de vuelo conflictivas se encuentra el vuelo a punto fijo, una maniobra de vuelo central en muchas misiones de vehículos VToL. Se analizan estas condiciones críticas de vuelo y para ellas se deriva y describe el espacio de soluciones posible conocido como región indistinguible. Los resultados son verificados en simulación dónde se puede apreciar como un estimador de estado falla al intentar realizar su tarea cuando la aeronave está en vuelo a punto fijo. Seguidamente se presenta el diseño de filtros extendidos de Kalman (EKF) que proveen estimaciones del estado con la información limitada de los sensores disponibles. Se discuten conceptos que habitualmente no se presentan en la literatura como cuando actualizar o propagar en el algoritmo de estimación o que sistema de referencia se debe utilizar para representar adecuadamente las variables de estado. Esto lleva a la formulación algorítmica de cuatro filtros discretos basados en eventos, diferentes, pero en esencia equivalentes. Se derivan rutinas de inicialización para los filtros y se comparan los resultados en simulación bajo condiciones favorables de estimación. Con la idea de disminuir el efecto de volar en configuraciones de observabilidad conflictivas, se deriva un filtro alternativo basado en el filtro de Schmidt Kalman (SKF). El filtro propuesto comparte estructura con el EKF, tiene un mejor comportamiento allí dónde le EKF falla y una respuesta similar en el resto de condiciones de vuelo. La última parte de la tesis trata con la estimación de perturbaciones externas. Para ello se deriva un modelo lineal que relaciona fuerzas y momentos con velocidades junto a un modelo de alto orden para las perturbaciones. Se estudia su aplicación a dos modelos para la estimación de perturbaciones ya presentes en la literatura. Además, se proponen dos nuevos filtros de Kalman que se aprovechan de la linealidad del modelo. Se presenta una comparativa basada en la simulación de escenarios ideales así como realistas que demuestra que los filtros KF superan al resto. Esta misma parte de la tesis presenta el diseño genérico de estimadores "quadratic bounded" para sistemas dinámicos lineales cuya incertidumbre se encuentra acotada dentro de elipsoides. Estos estimadores maximizan un compromiso, ajustable por el usuario que contempla la velocidad de convergencia así como el volumen de la solución final que contiene el error de estimación. Se deriva un observador de perturbaciones para plataformas aéreas basado en el modelo de alto orden arriba mencionado. Finalmente, se presenta un análisis del desempeño de estimación en función de los parámetros de diseño del filtro

Automatic Flight Control Systems

The history of flight control is inseparably linked to the history of aviation itself. Since the early days, the concept of automatic flight control systems has evolved from mechanical control systems to highly advanced automatic fly-by-wire flight control systems which can be found nowadays in military jets and civil airliners. Even today, many research efforts are made for the further development of these flight control systems in various aspects. Recent new developments in this field focus on a wealth of different aspects. This book focuses on a selection of key research areas, such as inertial navigation, control of unmanned aircraft and helicopters, trajectory control of an unmanned space re-entry vehicle, aeroservoelastic control, adaptive flight control, and fault tolerant flight control. This book consists of two major sections. The first section focuses on a literature review and some recent theoretical developments in flight control systems. The second section discusses some concepts of adaptive and fault-tolerant flight control systems. Each technique discussed in this book is illustrated by a relevant example

Machine Learning and System Identification for Estimation in Physical Systems

In this thesis, we draw inspiration from both classical system identification and modern machine learning in order to solve estimation problems for real-world, physical systems. The main approach to estimation and learning adopted is optimization based. Concepts such as regularization will be utilized for encoding of prior knowledge and basis-function expansions will be used to add nonlinear modeling power while keeping data requirements practical.The thesis covers a wide range of applications, many inspired by applications within robotics, but also extending outside this already wide field.Usage of the proposed methods and algorithms are in many cases illustrated in the real-world applications that motivated the research.Topics covered include dynamics modeling and estimation, model-based reinforcement learning, spectral estimation, friction modeling and state estimation and calibration in robotic machining.In the work on modeling and identification of dynamics, we develop regularization strategies that allow us to incorporate prior domain knowledge into flexible, overparameterized models. We make use of classical control theory to gain insight into training and regularization while using tools from modern deep learning. A particular focus of the work is to allow use of modern methods in scenarios where gathering data is associated with a high cost.In the robotics-inspired parts of the thesis, we develop methods that are practically motivated and make sure that they are implementable also outside the research setting. We demonstrate this by performing experiments in realistic settings and providing open-source implementations of all proposed methods and algorithms

Model-based Control of Upper Extremity Human-Robot Rehabilitation Systems

Stroke rehabilitation technologies have focused on reducing treatment cost while improving effectiveness. Rehabilitation robots are generally developed for home and clinical usage to: 1) deliver repetitive and stimulating practice to post-stroke patients, 2) minimize therapist interventions, and 3) increase the number of patients per therapist, thereby decreasing the associated cost. The control of rehabilitation robots is often limited to black- or gray-box approaches; thus, safety issues regarding the human-robot interaction are not easily considered. Furthermore, despite numerous studies of control strategies for rehabilitation, there are very few rehabilitation robots in which the tasks are implemented using optimal control theory. Optimal controllers using physics-based models have the potential to overcome these issues. This thesis presents advanced impedance- and model-based controllers for an end-effector-based upper extremity stroke rehabilitation robot. The final goal is to implement a biomechanically-plausible real-time nonlinear model predictive control for the studied rehabilitation system. The real-time term indicates that the controller computations finish within the sampling frequency time. This control structure, along with advanced impedance-based controllers, can be applied to any human-environment interactions. This makes them promising tools for different types of assistive devices, exoskeletons, active prostheses and orthoses, and exercise equipment. In this thesis, a high-fidelity biomechatronic model of the human-robot interaction is developed. The rehabilitation robot is a 2 degree-of-freedom parallelogram linkage with joint friction and backlash, and nonlinear dynamics. The mechatronic model of the robot with relatively accurate identified dynamic parameters is used in the human-robot interaction plant. Different musculoskeletal upper extremity, biomechanic, models are used to model human body motions while interacting with the rehabilitation robot model. Human-robot interaction models are recruited for model-in-loop simulations, thereby tuning the developed controllers in a structured resolution. The interaction models are optimized for real-time simulations. Thus, they are also used within the model-based control structures to provide biofeedback during a rehabilitation therapy. In robotic rehabilitation, because of physical interaction of the patient with a mechanical device, safety is a fundamental element in the design of a controller. Thus, impedance-based assistance is commonly used for robotic rehabilitation. One of our objectives is to achieve a reliable and real-time implementable controller. In our definition, a reliable controller is capable of handling variable exercises and admittance interactions. The controller should reduce therapist intervention and improve the quality of the rehabilitation. Hence, we develop advanced impedance-based assistance controllers for the rehabilitation robot. Overall, two types of impedance-based (i.e., hybrid force-impedance and optimal impedance) controllers are developed and tuned using model-in-loop simulations. Their performances are assessed using simulations and/or experiments. Furthermore, their drawbacks are discussed and possible methods for their improvements are proposed. In contrast to black/gray-box controllers, a physics-based model can leverage the inherent dynamics of the system and facilitate implementation of special control techniques, which can optimize a specific performance criterion while meeting stringent system constraints. Thus, we present model-based controllers for the upper extremity rehabilitation robot using our developed musculoskeletal models. Two types of model-based controllers (i.e., nonlinear model predictive control using external 3-dimensional musculoskeletal model or internal 2-dimensional musculoskeletal model) are proposed. Their performances are evaluated in simulations and/or experiments. The biomechanically-plausible nonlinear model predictive control using internal 2-dimensional musculoskeletal model predicts muscular activities of the human subject and provides optimal assistance in real-time experiments, thereby conforming to our final goal for this project

New Approaches in Automation and Robotics

The book New Approaches in Automation and Robotics offers in 22 chapters a collection of recent developments in automation, robotics as well as control theory. It is dedicated to researchers in science and industry, students, and practicing engineers, who wish to update and enhance their knowledge on modern methods and innovative applications. The authors and editor of this book wish to motivate people, especially under-graduate students, to get involved with the interesting field of robotics and mechatronics. We hope that the ideas and concepts presented in this book are useful for your own work and could contribute to problem solving in similar applications as well. It is clear, however, that the wide area of automation and robotics can only be highlighted at several spots but not completely covered by a single book