with Application to Autonomous Vehicles
|
|
- Trevor Ryan
- 6 years ago
- Views:
Transcription
1 Nonlinear with Application to Autonomous Vehicles (Ph.D. Candidate) C. Silvestre (Supervisor) P. Oliveira (Co-supervisor) Institute for s and Robotics Instituto Superior Técnico Portugal January 2010
2 Presentation outline Nonlinear and 1. Thesis outline Main contributions 2. Kalman Filter s Embedded UAV model for INS aiding Nonlinear Complementary Kalman filter 3. Combination of and for observer navigation system 4. and Future Work
3 Problem statement problem Estimate attitude and of a rigid body with respect to a reference frame, using available sensor data. and criteria Stability: the state estimate converges to the real and attitude. Performance: the state estimate is obtained by exploiting the sensor readings with optimality criteria.
4 Thesis outline EKF/INS + Advanced Vector Aiding IMU + Landmark Detection and EKF/INS + Vehicle Model Aiding Kalman Filtering Complementary Kalman Filtering IMU + Vector Observations Nonlinear Observers The proposed navigation systems are derived using two methodologies Kalman filtering techniques; and stability theory. IMU + GPS New Stability Results using Density Functions
5 Main contributions: Kalman filtering Kalman Filtering (A) EKF/INS + Advanced Vector Aiding (A) EKF/INS + Vehicle Model Aiding (B) Complementary Kalman Filtering and Main contributions in the field of navigation systems based on Kalman filtering (A) Advanced aiding techniques for EKF/INS navigation systems - modelling frequency contents of vector readings, - integrating efficiently the dynamic of the vehicle. (B) Nonlinear complementary Kalman filters - endowed with stability and performance properties, - combining stochastic approach and frequency domain design.
6 Main contributions: Nonlinear Nonlinear Observers and (A) IMU + Landmark Detection (A) IMU + Vector Observations (A) IMU + GPS (B) New Stability Results using Density Functions Main contributions in the field of (A) Nonlinear attitude and for inertial systems - with diverse aiding sensors. - endowed with stability properties for worst-case errors. (B) New tools - based on the combination of density and functions, - for almost GAS and almost ISS analysis of systems. - that eventually yield almost ISS of the proposed.
7 Presentation outline Nonlinear and 1. Thesis outline Main contributions 2. Kalman Filter s Embedded UAV model for INS aiding Nonlinear Complementary Kalman filter 3. Combination of and for observer navigation system 4. and Future Work
8 INS/GPS aided by selective frequency contents EKF/INS navigation system architecture Aiding Sensors GPS Dynamic Vector Readings GPS, Position, Position, Magnetometer Velocity, Velocity and Gravity and Selective Bias Attitude Errors Frequency Computation Compensation Contents Inertial Sensors Rate Gyro Accelerometer INS (Error Correction Routine) Measurement Residual Calculation EKF and High-accuracy, multi-rate INS computes, velocity and attitude based on the inertial sensor readings. Aiding sensor information, such as GPS, magnetometer and gravity selective frequency contents are introduced in the EKF for error estimation and compensation. Direct-feedback error compensation.
9 Embedded UAV model for INS aiding Vehicle techniques: External VD aiding Aiding Sensors and (Bias Update) Inertial Sensors Thrusters Input (Error Correction Routine) INS? Vehicle Model (Error Correction Routine) Measurement Residual Calculation The external vehicle dynamics (VD) aiding is implemented using a standalone simulator. The INS and VD error derivation, estimation, and compensation techniques are similar. EKF
10 Embedded UAV model for INS aiding Vehicle techniques: aiding Aiding Sensors and (Bias Update) Inertial Sensors Thrusters Input (Error Correction Routine) INS Vehicle Model Measurement Residual Calculation The embedded vehicle dynamics (VD) are integrated directly in the EKF architecture. EKF The vehicle model equations are computed using the inertial estimates. The computational load of VD aiding is reduced and the implementation flexibility is added, while retaining the accuracy enhancements of VD aiding. B v ω
11 Embedded UAV model for INS aiding Vario X-Treme helicopter model The embedded VD aiding technique was validated for a dynamic model of the Vario X-Treme R/C Helicopter. and Vario X-treme R/C helicopter The helicopter dynamics are described using a six degree of freedom rigid body model that includes the effects of the main rotor, Bell-Hiller stabilizing bar, tail rotor, fuselage, horizontal tail plane, and vertical fin.
12 Embedded UAV model for INS aiding Simulation results GPS Aiding Vario X-Treme Aiding GPS Aiding Vario X-Treme Aiding δv y (m/s) δb a x (m/s 2 ) time(s) time(s) and δb ω y (rad/s) x 10-3 GPS Aiding Vario X-Treme Aiding time(s) Bias and velocity estimation results are enhanced. The application of the embedded VD aiding to a complex and Vario X-Treme helicopter model validates the proposed technique.
13 and Embedded UAV model for INS aiding Simulation results GPS Aided External VD Aided Aided (ω, B v) aiding B v aiding Execution Time (s) The embedded VD aiding is computationally more efficient than the classical VD aiding. RMS Aiding information δp (m) δv (m/s) Yaw error( o ) Pitch error( o ) Roll error( o ) GPS Vario X-Treme Model Vario X-Treme Model (z v only) The VD linear velocity aiding yields about the accuracy of the full VD aiding and has a negligible computational cost with respect to GPS aiding.
14 Nonlinear complementary Kalman filter system architecture Euler Angles Estimate Rate Gyro Bias Estimate and The navigation system is cascade architecture of an attitude and a complementary filters. The proposed system exploits the sensor information over complementary frequency regions. Position Estimate Body Velocity Estimate The attitude and filters are endowed with stability and performance properties.
15 Nonlinear complementary Kalman filter Sensor fusion Position Filter Attitude Filter and Low Frequency High Frequency GPS Accelerometer Integration Vector Observations Rate Gyro Integration The complementary filters combine sensor information in the frequency domain. However, the feedback gains can be designed using a stochastic characterization of the sensors.
16 Nonlinear complementary Kalman filter Attitude complementary filter and The gainsk 1λ, K 2λ are computed for the LTI system [ ] [ ] [ ] [ ] [ ] xλ k+1 I T I xλ = k T I 0 wωr k +, x b k+1 0 I x b k 0 I w b k y x k = [ I 0 ] [ ] x λ k + v x λ k. b k The attitude complementary filter is uniformly asymptotically stable for bounded roll (θ<π). The complementary filter is the steady-state Kalman filter for the attitude kinematics, assuming constant roll and pitch. Performance degradation for time-varying roll and pitch is small.
17 Nonlinear complementary Kalman filter Position complementary filter and The gains K are computed for the LTI system [ 1p, K 2p ] [ ] [ ] [ ] [ ] xp k+1 I T I xp = k I T 2 wp + k, x v k+1 0 I x v k 0 T w v k y x k = [ I 0 ] [ ] x p k + v x p k. v k The complementary filter is uniformly asymptotically stable and is identified with the steady-state Kalman filter for the kinematics with isotropic accelerometer noise.
18 Nonlinear complementary Kalman filter Experimental results: DELFIMx catamaran and
19 and Nonlinear complementary Kalman filter Experimental results: Time domain X (m) s s s s TRAJECTORY ESTIMATION 300 s 350 s 400 s 550 s 600 s Comp. Filter GPS Unit 500 s 450 s 650 s 700 s Y (m) YAW ESTIMATION 950 s 986 s 750 s 900 s 800 s 850 s Body Velocity (m/s) Time (s) Yaw ( o ) Pitch ( o ) Roll ( o ) BODY VELOCITY ESTIMATION B vx B vy B vz PITCH AND ROLL ESTIMATION Time (s)
20 Nonlinear complementary Kalman filter Experimental results: Frequency domain AIDING SENSOR INERTIAL SENSOR INTEGRATION FILTER ESTIMATE (Pendulum) (Rate Gyro) ˆθ PITCH and X-AXIS POSITION (GPS) (Accelerometer) ˆp x
21 Presentation outline Nonlinear and 1. Thesis outline Main contributions 2. Kalman Filter s Embedded UAV model for INS aiding Nonlinear Complementary Kalman filter 3. Combination of and for observer navigation system 4. and Future Work
22 based navigation system design Problem formulation: Landmark readings Objective (Landmark based observer) ˆR ˆp q r ω r v r Estimate attitude (R ) and (p) of a rigid body using landmark observations (q r ) and non-ideal angular and linear velocity measurements (w r and v r,respectively). and Rigid Body Kinematics Ṙ = R (ω), Bṗ = B v (ω) B p Velocity Measurements ω r =ω+ b ω, v r = B v+b v Landmark Measurements q r i = R L x i B p
23 based navigation system design Problem formulation: Vector observations Objective (Vector based attitude observer) ˆR Estimate attitude ( R) of a rigid body using vector observations (hh r ) and non-ideal angular velocity measurements (w r ). ω r and Rigid Body Kinematics Body Frame Vectors (measured) H r = [ h r1... h r n ] = [B h 1... B h n ] Ṙ =R (ω) =R H. Velocity Measurements ω r =ω+b ω Reference Vectors (known) H = [L ] h 1... L h n, {L} local frame {B} body frame
24 and based navigation system design Observer design technique Observer Methodology Define a function V V(x) based on the observation error of the aiding sensors (landmarks/vector readings). Derive a feedback law such that V(x)<0. V 0 Analyze the stability properties of the closed loop system using suitable based tools. Issues Topological obstacles to global stability on manifolds, namely SE(3). Relaxation to almost global stability and almost ISS frameworks is adopted. The feedback law must be a function of the sensor readings. The true and orientation are unknown. Velocity readings can be distorted by bias and/or noise.
25 and based navigation system design Observer design: Landmark based observer The synthesis Function is a linear combination of landmark readings and bias estimation errors V b = γ ϕ n 1 i=1 B û i B u i 2 + γ p B û n B u n 2 + γ bω b ω bω + γ bv b v bv where B u j=1..(n 1) = n 1 i=1 a ij(q i+1 q i ), B u n = 1 n n i=1 q i. The obtained observer kinematics are given by ˆR = ˆR (ˆω), B ˆp = B ˆv (ˆω) B ˆp, (B ˆb ω = γ b (γ ϕ s ω γ p ˆp ) s v), ˆb v = γ p s v, γ b n where s ω = ( ˆR XD X A X e i ) (QD X A X e i ), s v = B ˆp + 1 n q i, ( ( ˆω =ω r ˆb i=1 ω k ω s ω, B ˆv = v r ˆb v + ω r ˆb ) ) n i=1 (B ω k v I s v + k ω ˆp ) s ω, that are a function of the sensor readings (output feedback).
26 and based navigation system design Observer design: Vector based observer The synthesis Function is a linear combination of vector readings and bias estimation error where The obtained observer kinematics are given by where B u j = n i=1 a ijh i. ˆω = ˆR HA H A H H r V b = n 1 i=1 B û i B u i 2 + γ bω b ω bω ˆR = ˆR ( ˆω), (ω r ˆb ) ω k ω s ω, s ω = ˆb ω = k bω s ω, n ( ˆR HA H e i ) (H r A H e i ), that are a function of the sensor readings (output feedback). i=1
27 and based navigation system design Properties of the derived Observer Properties Almost GAS with exponential convergence Almost all initial conditions converge to the origin for ideal velocity measurements. Dynamic bias estimation with exponential convergence for worst-case initial conditions Almost all initial conditions converge to the origin for the case of biased velocity readings. Output feedback formulation The derived feedback law is an explicit function of the sensor measurements. Sensor setup characterization Necessary and sufficient landmark/vector geometry for pose estimation is derived. Directionality of the estimation errors is analyzed.
28 and Combination of and Almost ISS analysis Analysis Method Obtain almost ISS by combining local ISS with weakly almost ISS. Step 1 (Local ISS) Find a region γ 1 ( u ) < x(t) < r V < 0, yielding Pro (Almost ISS) where u x(t 0 ) < r lim sup t x(t) γ 1 ( u ). Step 2 (Weakly almost ISS) Find a density function ρ such that div(ρf) > 0 for x(t) > γ 2 ( u ), which implies u a.a.x(t 0 ) lim inf t x(t) γ 2 ( u ). If the system is locally ISS and weakly almost ISS, then the system is almost ISS, with u a.a.x(t 0 ) lim sup t x(t) γ 1 ( u ).
29 and Combination of and Almost GAS analysis Analysis Method Given the largest invariant set M in that M \ {0} is unstable, yielding agas of {0}. {x : V (x) = 0}, a density function ρ can show The stability of an equilibrium point can be excluded using a density function analysis. Theorem 1 Suppose there exists a density function ρ :R n R + that is C 1 and integrable in a neighborhood U of x u R n. If div(ρf) > 0 in U then the global inset of x u has zero measure. Almost GAS of the origin is obtained by combining Theorem 1 with LaSalle's invariance principle. Pro Let the M be the largest invariant set in {x : V (x) = 0} and assume that M is a countable union of isolated points. If there is a density function ρ that satisfies the conditions of Theorem 1 for all x u M \ {0}, then the origin is almost GAS.
30 and Combination of and Application to Nonlinear Observers If rate gyro noise is considered, the proposed tools show that the attitude observer is almost ISS with respect to R =I, that is u a.a.r(t 0 ) I R 2 lim sup t I R(t) 2 γ 1 ( u ) I R(t 0 ) 2 < r(u max ) I R(t 0 ) 2 > r(u max ) r(u max ) γ 1 (u max ) Time (s) Almost GAS of a observer with biased velocity readings is obtained, namely almost all the trajectories of the system θ = sin(θ) + b, converge to the set ḃ = sin(θ) {(θ, b) = (2πk, 0), k Z}.
31 and navigation system Problem formulation Objective Estimate attitude (R ) and (p) of a rigid body using pseudorange observations (p ρ ij ) and non-ideal angular velocity and acceleration measurements (w r and v r,respectively). ω r a r ˆR ˆp Rigid Body Kinematics Ṙ =R (ω), ṗ = v, v = a Inertial Measurements ω r =ω+ b ω + n ω, a r = R T (a g) + n a Pseudorange Measurements ρ ij = p j p S i + b c (satellite i, receiver j)
32 navigation system Observer configuration and The navigation system is described by a cascade of an attitude observer and a observer. Three GPS receivers onboard the vehicle are necessary for attitude estimation. In alternative, vector readings can be adopted.
33 and navigation system Properties of the derived observer GPS/IMU Observer Properties Almost GAS with exponential convergence Almost all initial conditions converge to the origin for ideal inertial measurements. Dynamic bias estimation with exponential convergence for worst-case initial conditions Almost all initial conditions converge to the origin for the case of biased velocity readings. Almost ISS with inertial sensor noise The estimation errors converge to a known neighborhood of the origin. Output feedback formulation The derived feedback law is an explicit function of the sensor measurements.
34 navigation system Simulation results GRAVITY COMPENSATION ERROR n a max = 0.3m/s 2, n ω max = 0rad/s n a max = 3m/s 2, n ω max = 0rad/s n a max = 0.3m/s 2, n ω max = 10 π 180 rad/s VELOCITY ESTIMATION ERROR n a max = 0.3m/s 2, n ω max = 0rad/s n a max = 3m/s 2, n ω max = 0rad/s n a max = 0.3m/s 2, n ω max = 10 π 180 rad/s E ṽ (m/s) and E p (m) Time (s) POSITION ESTIMATION ERROR n a max = 0.3m/s 2, n ω max = 0rad/s n a max = 3m/s 2, n ω max = 0rad/s n a max = 0.3m/s 2, n ω max = 10 π 180 rad/s I R Time (s) ATTITUDE ESTIMATION ERROR n a max = 0.3m/s 2, n ω max = 0rad/s n a max = 0.3m/s 2, n ω max = 10 π 180 rad/s Time (s) Time (s)
35 Presentation outline Nonlinear and 1. Thesis outline Main contributions 2. Kalman Filter s Embedded UAV model for INS aiding Nonlinear Complementary Kalman filter 3. Combination of and for observer navigation system 4. and Future Work
36 and future work EKF/INS + Advanced Vector Aiding IMU + Landmark Detection and EKF/INS + Vehicle Model Aiding Kalman Filtering Complementary Kalman Filtering Performance driven design Integrated advanced aiding techniques; Accounted for a variety of sensor non-idealities and disturbances. IMU + Vector Observations Nonlinear Observers IMU + GPS New Stability Results using Density Functions Stability driven design Guaranteed stability with some sensor non-idealities; Accounting for extra non-idealities implies system redesign.
37 Journal publications Nonlinear and Kalman Filter s - Embedded UAV model and Laser Aiding for inertial s Control Engineering Practice, Elsevier - Discrete-time complementary filters for attitude and :, analysis and experimental validation Transactions on Control s Technology, IEEE - A and attitude observer on SE(3) using landmark measurements s & Control Letters, Elsevier - Combination of and for - navigation system In preparation Magnetometer Calibration in Sensor Frame Transactions on Aerospace and Control s, IEEE
38 Nonlinear with Application to Autonomous Vehicles (Ph.D. Candidate) C. Silvestre (Supervisor) P. Oliveira (Co-supervisor) Institute for s and Robotics Instituto Superior Técnico Portugal January 2010
Discrete Time-Varying Attitude Complementary Filter
29 American Control Conference Hyatt Regency Riverfront, St. Louis, MO, USA June 1-12, 29 FrA4.2 Discrete Time-Varying Attitude Complementary Filter J.F. Vasconcelos, C. Silvestre, P. Oliveira, P. Batista,
More informationA Landmark Based Nonlinear Observer for Attitude and Position Estimation with Bias Compensation
Proceedings of the 7th World Congress The International Federation of Automatic Control Seoul Korea July 6-8 A Landmark Based Nonlinear Observer for Attitude and Position Estimation with Bias Compensation
More informationMARINE biologists, oceanographers, and other ocean researchers
IEEE TRANSACTIONS ON CONTROL SYSTEMS TECHNOLOGY, VOL. 19, NO. 1, JANUARY 2011 181 Discrete-Time Complementary Filters for Attitude and Position Estimation: Design, Analysis and Experimental Validation
More informationInertial Navigation System Aided by GPS and Selective Frequency Contents of Vector Measurements
Inertial Navigation System Aided by GPS and Selective Frequency Contents of Vector Measurements J.F. Vasconcelos, P. Oliveira, Carlos Silvestre Instituto Superior Técnico, Institute for Systems and Robotics,
More informationAutomated Tuning of the Nonlinear Complementary Filter for an Attitude Heading Reference Observer
Automated Tuning of the Nonlinear Complementary Filter for an Attitude Heading Reference Observer Oscar De Silva, George K.I. Mann and Raymond G. Gosine Faculty of Engineering and Applied Sciences, Memorial
More informationIEEE TRANSACTIONS ON AUTOMATIC CONTROL, VOL. 53, NO. 5, JUNE
IEEE TRANSACTIONS ON AUTOMATIC CONTROL, VOL 53, NO 5, JUNE 2008 1203 Nonlinear Complementary Filters on the Special Orthogonal Group Robert Mahony, Senior Member, IEEE, Tarek Hamel, Member, IEEE, and Jean-Michel
More informationUAV Navigation: Airborne Inertial SLAM
Introduction UAV Navigation: Airborne Inertial SLAM Jonghyuk Kim Faculty of Engineering and Information Technology Australian National University, Australia Salah Sukkarieh ARC Centre of Excellence in
More informationTrajectory tracking & Path-following control
Cooperative Control of Multiple Robotic Vehicles: Theory and Practice Trajectory tracking & Path-following control EECI Graduate School on Control Supélec, Feb. 21-25, 2011 A word about T Tracking and
More informationCS491/691: Introduction to Aerial Robotics
CS491/691: Introduction to Aerial Robotics Topic: Midterm Preparation Dr. Kostas Alexis (CSE) Areas of Focus Coordinate system transformations (CST) MAV Dynamics (MAVD) Navigation Sensors (NS) State Estimation
More informationContinuous Preintegration Theory for Graph-based Visual-Inertial Navigation
Continuous Preintegration Theory for Graph-based Visual-Inertial Navigation Kevin Ecenhoff - ec@udel.edu Patric Geneva - pgeneva@udel.edu Guoquan Huang - ghuang@udel.edu Department of Mechanical Engineering
More informationA Complementary Filter for Attitude Estimation of a Fixed-Wing UAV
A Complementary Filter for Attitude Estimation of a Fixed-Wing UAV Mark Euston, Paul Coote, Robert Mahony, Jonghyuk Kim and Tarek Hamel Abstract This paper considers the question of using a nonlinear complementary
More informationQuadrotor Modeling and Control
16-311 Introduction to Robotics Guest Lecture on Aerial Robotics Quadrotor Modeling and Control Nathan Michael February 05, 2014 Lecture Outline Modeling: Dynamic model from first principles Propeller
More informationAerial Robotics. Vision-based control for Vertical Take-Off and Landing UAVs. Toulouse, October, 2 nd, Henry de Plinval (Onera - DCSD)
Aerial Robotics Vision-based control for Vertical Take-Off and Landing UAVs Toulouse, October, 2 nd, 2014 Henry de Plinval (Onera - DCSD) collaborations with P. Morin (UPMC-ISIR), P. Mouyon (Onera), T.
More informationTTK4190 Guidance and Control Exam Suggested Solution Spring 2011
TTK4190 Guidance and Control Exam Suggested Solution Spring 011 Problem 1 A) The weight and buoyancy of the vehicle can be found as follows: W = mg = 15 9.81 = 16.3 N (1) B = 106 4 ( ) 0.6 3 3 π 9.81 =
More informationCascade Attitude Observer for the SLAM filtering problem
Cascade Attitude Observer for the filtering problem Elias Bjørne Edmund Førland Brekke Tor Arne Johansen Abstract This article presents an attitude observer that exploits both bearing and range measurements
More informationEigenstructure Assignment for Helicopter Hover Control
Proceedings of the 17th World Congress The International Federation of Automatic Control Eigenstructure Assignment for Helicopter Hover Control Andrew Pomfret Stuart Griffin Tim Clarke Department of Electronics,
More informationMeasurement Observers for Pose Estimation on SE(3)
Measurement Observers for Pose Estimation on SE(3) By Geoffrey Stacey u4308250 Supervised by Prof. Robert Mahony 24 September 2010 A thesis submitted in part fulfilment of the degree of Bachelor of Engineering
More informationAdaptive Unscented Kalman Filter with Multiple Fading Factors for Pico Satellite Attitude Estimation
Adaptive Unscented Kalman Filter with Multiple Fading Factors for Pico Satellite Attitude Estimation Halil Ersin Söken and Chingiz Hajiyev Aeronautics and Astronautics Faculty Istanbul Technical University
More informationRao-Blackwellized Particle Filtering for 6-DOF Estimation of Attitude and Position via GPS and Inertial Sensors
Rao-Blackwellized Particle Filtering for 6-DOF Estimation of Attitude and Position via GPS and Inertial Sensors GRASP Laboratory University of Pennsylvania June 6, 06 Outline Motivation Motivation 3 Problem
More informationState observers for invariant dynamics on a Lie group
State observers for invariant dynamics on a Lie group C. Lageman, R. Mahony, J. Trumpf 1 Introduction This paper concerns the design of full state observers for state space systems where the state is evolving
More informationAdaptive Estimation of Measurement Bias in Six Degree of Freedom Inertial Measurement Units: Theory and Preliminary Simulation Evaluation
Adaptive Estimation of Measurement Bias in Six Degree of Freedom Inertial Measurement Units: Theory and Preliminary Simulation Evaluation Andrew R. Spielvogel and Louis L. Whitcomb Abstract Six-degree
More informationA Low-Cost GPS Aided Inertial Navigation System for Vehicular Applications
A Low-Cost GPS Aided Inertial Navigation System for Vehicular Applications ISAAC SKOG Master of Science Thesis Stockholm, Sweden 2005-03-09 IR-SB-EX-0506 1 Abstract In this report an approach for integration
More informationInvariant Extended Kalman Filter: Theory and application to a velocity-aided estimation problem
Invariant Extene Kalman Filter: Theory an application to a velocity-aie estimation problem S. Bonnabel (Mines ParisTech) Joint work with P. Martin (Mines ParisTech) E. Salaun (Georgia Institute of Technology)
More informationOn the Observability and Self-Calibration of Visual-Inertial Navigation Systems
Center for Robotics and Embedded Systems University of Southern California Technical Report CRES-08-005 R B TIC EMBEDDED SYSTEMS LABORATORY On the Observability and Self-Calibration of Visual-Inertial
More informationStabilization of a 3D Rigid Pendulum
25 American Control Conference June 8-, 25. Portland, OR, USA ThC5.6 Stabilization of a 3D Rigid Pendulum Nalin A. Chaturvedi, Fabio Bacconi, Amit K. Sanyal, Dennis Bernstein, N. Harris McClamroch Department
More informationAutonomous Helicopter Flight via Reinforcement Learning
Autonomous Helicopter Flight via Reinforcement Learning Authors: Andrew Y. Ng, H. Jin Kim, Michael I. Jordan, Shankar Sastry Presenters: Shiv Ballianda, Jerrolyn Hebert, Shuiwang Ji, Kenley Malveaux, Huy
More informationExperiments on Stabilization of the Hanging Equilibrium of a 3D Asymmetric Rigid Pendulum
Proceedings of the 25 IEEE Conference on Control Applications Toronto, Canada, August 28-3, 25 MB4.5 Experiments on Stabilization of the Hanging Equilibrium of a 3D Asymmetric Rigid Pendulum Mario A. Santillo,
More informationOutput-feedback control for stabilization on SE(3)
Output-feedback control for stabilization on SE(3) Rita Cunha, Carlos Silvestre, and João Hespanha Abstract This paper addresses the problem of stabilizing systems that evolve on SE(3). The proposed solution
More informationEvaluation of different wind estimation methods in flight tests with a fixed-wing UAV
Evaluation of different wind estimation methods in flight tests with a fixed-wing UAV Julian Sören Lorenz February 5, 2018 Contents 1 Glossary 2 2 Introduction 3 3 Tested algorithms 3 3.1 Unfiltered Method
More informationGeometric Nonlinear Observer Design for SLAM on a Matrix Lie Group
218 IEEE Conference on Decision and Control (CDC Miami Beach, FL, USA, Dec. 17-19, 218 Geometric Nonlinear Observer Design for SLAM on a Matrix Lie Group Miaomiao Wang and Abdelhamid Tayebi Abstract This
More informationMetric Visual-Inertial Navigation System Using Single Optical Flow Feature
13 European Control Conference (ECC) July 17-19, 13, Zürich, Switzerland. Metric Visual-Inertial Navigation System Using Single Optical Flow Feature Sammy Omari 1 and Guillaume Ducard Abstract This paper
More informationMulti-layer Flight Control Synthesis and Analysis of a Small-scale UAV Helicopter
Multi-layer Flight Control Synthesis and Analysis of a Small-scale UAV Helicopter Ali Karimoddini, Guowei Cai, Ben M. Chen, Hai Lin and Tong H. Lee Graduate School for Integrative Sciences and Engineering,
More informationInvestigation of the Attitude Error Vector Reference Frame in the INS EKF
Investigation of the Attitude Error Vector Reference Frame in the INS EKF Stephen Steffes, Jan Philipp Steinbach, and Stephan Theil Abstract The Extended Kalman Filter is used extensively for inertial
More informationTwo dimensional rate gyro bias estimation for precise pitch and roll attitude determination utilizing a dual arc accelerometer array
Rochester Institute of Technology RIT Scholar Works Theses Thesis/Dissertation Collections -- Two dimensional rate gyro bias estimation for precise pitch and roll attitude determination utilizing a dual
More information3D Pendulum Experimental Setup for Earth-based Testing of the Attitude Dynamics of an Orbiting Spacecraft
3D Pendulum Experimental Setup for Earth-based Testing of the Attitude Dynamics of an Orbiting Spacecraft Mario A. Santillo, Nalin A. Chaturvedi, N. Harris McClamroch, Dennis S. Bernstein Department of
More informationFundamentals of attitude Estimation
Fundamentals of attitude Estimation Prepared by A.Kaviyarasu Assistant Professor Department of Aerospace Engineering Madras Institute Of Technology Chromepet, Chennai Basically an IMU can used for two
More informationOne Approach to the Integration of Inertial and Visual Navigation Systems
FATA UNIVERSITATIS (NIŠ) SER.: ELE. ENERG. vol. 18, no. 3, December 2005, 479-491 One Approach to the Integration of Inertial and Visual Navigation Systems Dedicated to Professor Milić Stojić on the occasion
More informationEstimation and Control of a Quadrotor Attitude
Estimation and Control of a Quadrotor Attitude Bernardo Sousa Machado Henriques Mechanical Engineering Department, Instituto Superior Técnico, Lisboa, Portugal E-mail: henriquesbernardo@gmail.com Abstract
More informationProblem 1: Ship Path-Following Control System (35%)
Problem 1: Ship Path-Following Control System (35%) Consider the kinematic equations: Figure 1: NTNU s research vessel, R/V Gunnerus, and Nomoto model: T ṙ + r = Kδ (1) with T = 22.0 s and K = 0.1 s 1.
More informationSensor Aided Inertial Navigation Systems
Arvind Ramanandan Department of Electrical Engineering University of California, Riverside Riverside, CA 92507 April, 28th 2011 Acknowledgements: 1 Prof. Jay A. Farrell 2 Anning Chen 3 Anh Vu 4 Prof. Matthew
More informationAttitude and Earth Velocity Estimation - Part I: Globally Exponentially Stable Observer
Attitude Earth Velocity Estimation - Part I: Globally Eponentially Stable Observer Pedro Batista, Carlos Silvestre, Paulo Oliveira Abstract The main contribution of this paper is the development of a novel
More informationApplication of state observers in attitude estimation using low-cost sensors
Application of state observers in attitude estimation using low-cost sensors Martin Řezáč Czech Technical University in Prague, Czech Republic March 26, 212 Introduction motivation for inertial estimation
More informationAttitude Estimation Version 1.0
Attitude Estimation Version 1. Francesco Farina May 23, 216 Contents 1 Introduction 2 2 Mathematical background 2 2.1 Reference frames and coordinate systems............. 2 2.2 Euler angles..............................
More informationIMU-Camera Calibration: Observability Analysis
IMU-Camera Calibration: Observability Analysis Faraz M. Mirzaei and Stergios I. Roumeliotis {faraz stergios}@cs.umn.edu Dept. of Computer Science & Engineering University of Minnesota Minneapolis, MN 55455
More informationVideo 8.1 Vijay Kumar. Property of University of Pennsylvania, Vijay Kumar
Video 8.1 Vijay Kumar 1 Definitions State State equations Equilibrium 2 Stability Stable Unstable Neutrally (Critically) Stable 3 Stability Translate the origin to x e x(t) =0 is stable (Lyapunov stable)
More informationSensor-based Simultaneous Localization and Mapping Part I: GAS Robocentric Filter
Sensor-based Simultaneous Localization and Mapping Part I: GAS Robocentric Filter Bruno J Guerreiro, Pedro Batista, Carlos Silvestre, and Paulo Oliveira Abstract This paper presents the design, analysis,
More informationThe Variational Attitude Estimator in the Presence of Bias in Angular Velocity Measurements
The Variational Attitude Estimator in the Presence of Bias in Angular Velocity Measurements Maziar Izadi 1, Sasi Prabhakaran 1, Amit Sanyal 2,, Carlos Silvestre 3, and Paulo Oliveira 4 Abstract Estimation
More informationExam - TTK 4190 Guidance & Control Eksamen - TTK 4190 Fartøysstyring
Page 1 of 6 Norges teknisk- naturvitenskapelige universitet Institutt for teknisk kybernetikk Faglig kontakt / contact person: Navn: Morten Pedersen, Universitetslektor Tlf.: 41602135 Exam - TTK 4190 Guidance
More informationVelocity Aided Attitude Estimation for Aerial Robotic Vehicles Using Latent Rotation Scaling
Velocity Aided Attitude Estimation for Aerial Robotic Vehicles Using Latent Rotation Scaling Guillaume Allibert, Robert Mahony, Moses Bangura To cite this version: Guillaume Allibert, Robert Mahony, Moses
More informationDesign of Adaptive Filtering Algorithm for Relative Navigation
Design of Adaptive Filtering Algorithm for Relative Navigation Je Young Lee, Hee Sung Kim, Kwang Ho Choi, Joonhoo Lim, Sung Jin Kang, Sebum Chun, and Hyung Keun Lee Abstract Recently, relative navigation
More informationVision and IMU Data Fusion: Closed-Form Determination of the Absolute Scale, Speed and Attitude
Vision and IMU Data Fusion: Closed-Form Determination of the Absolute Scale, Speed and Attitude Agostino Martinelli, Roland Siegwart To cite this version: Agostino Martinelli, Roland Siegwart. Vision and
More informationUnit quaternion observer based attitude stabilization of a rigid spacecraft without velocity measurement
Proceedings of the 45th IEEE Conference on Decision & Control Manchester Grand Hyatt Hotel San Diego, CA, USA, December 3-5, 6 Unit quaternion observer based attitude stabilization of a rigid spacecraft
More information1128 IEEE TRANSACTIONS ON CONTROL SYSTEMS TECHNOLOGY, VOL. 19, NO. 5, SEPTEMBER 2011
1128 IEEE TRANSACTIONS ON CONTROL SYSTEMS TECHNOLOGY, VOL 19, NO 5, SEPTEMBER 2011 Accelerometer Calibration and Dynamic Bias and Gravity Estimation: Analysis, Design, and Experimental Evaluation Pedro
More informationAutonomous Mobile Robot Design
Autonomous Mobile Robot Design Topic: Inertial Measurement Unit Dr. Kostas Alexis (CSE) Where am I? What is my environment? Robots use multiple sensors to understand where they are and how their environment
More informationState Estimation for Autopilot Control of Small Unmanned Aerial Vehicles in Windy Conditions
University of Colorado, Boulder CU Scholar Aerospace Engineering Sciences Graduate Theses & Dissertations Aerospace Engineering Sciences Summer 7-23-2014 State Estimation for Autopilot Control of Small
More informationFIBER OPTIC GYRO-BASED ATTITUDE DETERMINATION FOR HIGH- PERFORMANCE TARGET TRACKING
FIBER OPTIC GYRO-BASED ATTITUDE DETERMINATION FOR HIGH- PERFORMANCE TARGET TRACKING Elias F. Solorzano University of Toronto (Space Flight Laboratory) Toronto, ON (Canada) August 10 th, 2016 30 th AIAA/USU
More informationQuaternion based Extended Kalman Filter
Quaternion based Extended Kalman Filter, Sergio Montenegro About this lecture General introduction to rotations and quaternions. Introduction to Kalman Filter for Attitude Estimation How to implement and
More informationInertial Navigation and Various Applications of Inertial Data. Yongcai Wang. 9 November 2016
Inertial Navigation and Various Applications of Inertial Data Yongcai Wang 9 November 2016 Types of Gyroscope Mechanical Gyroscope Laser Gyroscope Sagnac Effect Stable Platform IMU and Strapdown IMU In
More informationMAE 142 Homework #5 Due Friday, March 13, 2009
MAE 142 Homework #5 Due Friday, March 13, 2009 Please read through the entire homework set before beginning. Also, please label clearly your answers and summarize your findings as concisely as possible.
More informationBaro-INS Integration with Kalman Filter
Baro-INS Integration with Kalman Filter Vivek Dadu c,b.venugopal Reddy a, Brajnish Sitara a, R.S.Chandrasekhar a & G.Satheesh Reddy a c Hindustan Aeronautics Ltd, Korwa, India. a Research Centre Imarat,
More informationGeneralized Multiplicative Extended Kalman Filter for Aided Attitude and Heading Reference System
Generalized Multiplicative Extended Kalman Filter for Aided Attitude and Heading Reference System Philippe Martin, Erwan Salaün To cite this version: Philippe Martin, Erwan Salaün. Generalized Multiplicative
More informationRobot Control Basics CS 685
Robot Control Basics CS 685 Control basics Use some concepts from control theory to understand and learn how to control robots Control Theory general field studies control and understanding of behavior
More informationVision-Aided Inertial Navigation: Closed-Form Determination of Absolute Scale, Speed and Attitude
Vision-Aided Inertial Navigation: Closed-Form Determination of Absolute Scale, Speed and Attitude Agostino Martinelli, Chiara Troiani, Alessandro Renzaglia To cite this version: Agostino Martinelli, Chiara
More informationChapter 2 Review of Linear and Nonlinear Controller Designs
Chapter 2 Review of Linear and Nonlinear Controller Designs This Chapter reviews several flight controller designs for unmanned rotorcraft. 1 Flight control systems have been proposed and tested on a wide
More informationAn Adaptive Filter for a Small Attitude and Heading Reference System Using Low Cost Sensors
An Adaptive Filter for a Small Attitude and eading Reference System Using Low Cost Sensors Tongyue Gao *, Chuntao Shen, Zhenbang Gong, Jinjun Rao, and Jun Luo Department of Precision Mechanical Engineering
More informationState Estimation for UAVs Using Sensor Fusion
State Estimation for UAVs Using Sensor Fusion Zsófia Bodó, Béla Lantos Budapest University of Technology and Economics, Department of Control Engineering and Information Technology, MTA-BME Control Engineering
More informationEE565:Mobile Robotics Lecture 6
EE565:Mobile Robotics Lecture 6 Welcome Dr. Ahmad Kamal Nasir Announcement Mid-Term Examination # 1 (25%) Understand basic wheel robot kinematics, common mobile robot sensors and actuators knowledge. Understand
More informationVN-100 Velocity Compensation
VN-100 Velocity Compensation Velocity / Airspeed Aiding for AHRS Applications Application Note Abstract This application note describes how the VN-100 can be used in non-stationary applications which require
More informationKalman Filter Enhancement for UAV Navigation
Kalman Filter Enhancement for UAV Navigation Roger Johnson* Jerzy Sasiade** Janusz Zalewsi* *University of Central Florida Orlando, FL 86-2450, USA **Carleton University Ottawa, Ont. KS 5B6, Canada Keywords
More informationFuzzy Adaptive Kalman Filtering for INS/GPS Data Fusion
A99936769 AMA-99-4307 Fuzzy Adaptive Kalman Filtering for INS/GPS Data Fusion J.Z. Sasiadek* and Q. Wang** Dept. of Mechanical & Aerospace Engineering Carleton University 1125 Colonel By Drive, Ottawa,
More informationPosition and Velocity USBL/IMU Sensor-based Navigation Filter
Milano (Italy) August 28 - September 2 211 Position and Velocity USBL/IMU Sensor-based Navigation Filter M Morgado P Batista P Oliveira and C Silvestre Institute for Systems and Robotics Instituto Superior
More informationNonlinear Landing Control for Quadrotor UAVs
Nonlinear Landing Control for Quadrotor UAVs Holger Voos University of Applied Sciences Ravensburg-Weingarten, Mobile Robotics Lab, D-88241 Weingarten Abstract. Quadrotor UAVs are one of the most preferred
More informationModeling Verticality Estimation During Locomotion
Proceedings of the 19th CISM-IFToMM Symposium on Robot Design, Dynamics, and Control, Romansy 212. pp. 651-656 Modeling Verticality Estimation During Locomotion Ildar Farkhatdinov 1 Hannah Michalska 2
More informationHigh-Accuracy Preintegration for Visual Inertial Navigation
High-Accuracy Preintegration for Visual Inertial Navigation Kevin Ecenhoff - ec@udel.edu Patric Geneva - pgeneva@udel.edu Guoquan Huang - ghuang@udel.edu Department of Mechanical Engineering University
More informationInversion Based Direct Position Control and Trajectory Following for Micro Aerial Vehicles
Inversion Based Direct Position Control and Trajectory Following for Micro Aerial Vehicles Markus W. Achtelik, Simon Lynen, Margarita Chli and Roland Siegwart Abstract In this work, we present a powerful,
More informationThe PVTOL Aircraft. 2.1 Introduction
2 The PVTOL Aircraft 2.1 Introduction We introduce in this chapter the well-known Planar Vertical Take-Off and Landing (PVTOL) aircraft problem. The PVTOL represents a challenging nonlinear systems control
More informationL 1 Adaptive Control for Autonomous Rotorcraft
9 American Control Conference Hyatt Regency Riverfront, St. Louis, MO, USA June 1-1, 9 ThB18.6 L 1 Adaptive Control for Autonomous Rotorcraft B. J. Guerreiro*, C. Silvestre*, R. Cunha*, C. Cao, N. Hovakimyan
More informationA Monocular Vision-aided Inertial Navigation System with Improved Numerical Stability
AIAA SciTech 5-9 January 215, Kissimmee, Florida AIAA Guidance, Navigation, and Control Conference AIAA 215-97 A Monocular Vision-aided Inertial Navigation System with Improved Numerical Stability Daniel
More informationSigma-Point Kalman Filters for Nonlinear Estimation and Sensor-Fusion - Applications to Integrated Navigation - Rudolph van der Merwe and Eric A.
Sigma-Point Kalman Filters for Nonlinear Estimation and Sensor-Fusion - Applications to Integrated Navigation - Rudolph van der Merwe and Eric A. Wan OGI School of Science & Engineering, Oregon Health
More informationVisual Feedback Attitude Control of a Bias Momentum Micro Satellite using Two Wheels
Visual Feedback Attitude Control of a Bias Momentum Micro Satellite using Two Wheels Fuyuto Terui a, Nobutada Sako b, Keisuke Yoshihara c, Toru Yamamoto c, Shinichi Nakasuka b a National Aerospace Laboratory
More informationBias Estimation for Invariant Systems on Lie Groups with Homogeneous Outputs
Bias Estimation for Invariant Systems on Lie Groups with Homogeneous Outputs A. Khosravian, J. Trumpf, R. Mahony, C. Lageman Abstract In this paper, we provide a general method of state estimation for
More informationPosition Control for a Class of Vehicles in SE(3)
Position Control for a Class of Vehicles in SE(3) Ashton Roza, Manfredi Maggiore Abstract A hierarchical design framework is presented to control the position of a class of vehicles in SE(3) that are propelled
More informationOn Attitude Observers and Inertial Navigation for Reference System Fault Detection and Isolation in Dynamic Positioning
On Attitude Observers and Inertial Navigation for Reference System Fault Detection and Isolation in Dynamic Positioning Robert H. Rogne, Tor A. Johansen, Thor I. Fossen, Center for Autonomous Marine Operations
More informationEstimating Body-Fixed Frame Velocity and Attitude from Inertial Measurements for a Quadrotor Vehicle
Estimating Body-Fixed Frame Velocity and Attitude from Inertial Measurements for a Quadrotor Vehicle Guillaume Allibert, Dinuka Abeywardena, Moses Bangura, Robert Mahony To cite this version: Guillaume
More informationChapter 4 The Equations of Motion
Chapter 4 The Equations of Motion Flight Mechanics and Control AEM 4303 Bérénice Mettler University of Minnesota Feb. 20-27, 2013 (v. 2/26/13) Bérénice Mettler (University of Minnesota) Chapter 4 The Equations
More informationVehicle state observer requirement specification
Complex Embedded Automotive Control Systems CEMACS DaimlerChrysler SINTEF Glasgow University Hamilton Institute Lund University Vehicle state observer requirement specification Public Interrim Report Work
More informationEE 570: Location and Navigation
EE 570: Location and Navigation Aided INS Aly El-Osery Kevin Wedeward Electrical Engineering Department, New Mexico Tech Socorro, New Mexico, USA In Collaboration with Stephen Bruder Electrical and Computer
More informationNONLINEAR ATTITUDE AND GYROSCOPE S BIAS ESTIMATION FOR A VTOL UAV
NONLINEAR ATTITUDE AND GYROSCOPE S BIAS ESTIMATION FOR A VTOL UAV Jean Michel Pflimlin,1 Tarek Hamel Philippe Souères Najib Metni LAAS - CNRS, 7, Av. du colonel Roche, 3177 Toulouse I3S - CNRS, Les Algorithmes,
More informationBarometer-Aided Road Grade Estimation
Barometer-Aided Road Grade Estimation Jussi Parviainen, Jani Hautamäki, Jussi Collin and Jarmo Takala Tampere University of Technology, Finland BIOGRAPHY Jussi Parviainen received his M.Sc. degree in May
More informationNonlinear attitude estimation with measurement decoupling and anti-windup gyro-bias compensation
Nonlinear attitude estimation with measurement decoupling and anti-windup gyro-bias compensation Minh-Duc Hua, Konrad Rudin, Guillaume Ducard, Tarek Hamel, Robert Mahony I3S UNS CNRS, Sophia Antipolis,
More informationAttitude Estimation and Control of VTOL UAVs
Western University Scholarship@Western Electronic Thesis and Dissertation Repository November 2011 Attitude Estimation and Control of VTOL UAVs Andrew D. Roberts The University of Western Ontario Supervisor
More informationNonlinear Observers for Integrated INS/GNSS Navigation Implementation Aspects
Nonlinear Observers for Integrated INS/GNSS Navigation Implementation Aspects Torleiv H. Bryne, Jakob M. Hansen, Robert H. Rogne, Nadezda Sokolova, Thor I. Fossen and Tor A. Johansen POC: T.H. Bryne (torleiv.h.bryne@itk.ntnu.no)
More informationSimplified Filtering Estimator for Spacecraft Attitude Determination from Phase Information of GPS Signals
WCE 7, July - 4, 7, London, U.K. Simplified Filtering Estimator for Spacecraft Attitude Determination from Phase Information of GPS Signals S. Purivigraipong, Y. Hashida, and M. Unwin Abstract his paper
More informationLecture 9: Modeling and motion models
Sensor Fusion, 2014 Lecture 9: 1 Lecture 9: Modeling and motion models Whiteboard: Principles and some examples. Slides: Sampling formulas. Noise models. Standard motion models. Position as integrated
More informationIntegration of a strapdown gravimeter system in an Autonomous Underwater Vehicle
Integration of a strapdown gravimeter system in an Autonomous Underwater Vehicle Clément ROUSSEL PhD - Student (L2G - Le Mans - FRANCE) April 17, 2015 Clément ROUSSEL ISPRS / CIPA Workshop April 17, 2015
More informationVisual Servoing for a Quadrotor UAV in Target Tracking Applications. Marinela Georgieva Popova
Visual Servoing for a Quadrotor UAV in Target Tracking Applications by Marinela Georgieva Popova A thesis submitted in conformity with the requirements for the degree of Master of Applied Science Graduate
More informationTopic # /31 Feedback Control Systems. Analysis of Nonlinear Systems Lyapunov Stability Analysis
Topic # 16.30/31 Feedback Control Systems Analysis of Nonlinear Systems Lyapunov Stability Analysis Fall 010 16.30/31 Lyapunov Stability Analysis Very general method to prove (or disprove) stability of
More informationExtended Kalman Filter for Spacecraft Pose Estimation Using Dual Quaternions*
Extended Kalman Filter for Spacecraft Pose Estimation Using Dual Quaternions* Nuno Filipe Michail Kontitsis 2 Panagiotis Tsiotras 3 Abstract Based on the highly successful Quaternion Multiplicative Extended
More informationESTIMATION OF THE LONGITUDINAL AND LATERAL VELOCITIES OF A VEHICLE USING EXTENDED KALMAN FILTERS
ESTIMATION OF THE LONGITUDINAL AND LATERAL VELOCITIES OF A VEHICLE USING EXTENDED KALMAN FILTERS A Thesis Presented to The Academic Faculty by Juan Camilo Alvarez In Partial Fulfillment of the Requirements
More informationVision-Aided Navigation Based on Three-View Geometry
Vision-Aided Navigation Based on hree-view Geometry Vadim Indelman, Pini Gurfil Distributed Space Systems Lab, Aerospace Engineering, echnion Ehud Rivlin Computer Science, echnion Hector Rotstein RAFAEL
More information