CELLO: A fast algorithm for Covariance Estimation

We present CELLO (Covariance Estimation and Learning through Likelihood Optimization), an algorithm for predicting the covariances of measurements based on any available informative features. This algorithm is intended to improve the accuracy and reliability of on-line state estimation by providing a principled way to extend the conventional fixed-covariance Gaussian measurement model. We show that in experiments, CELLO learns to predict measurement covariances that agree with empirical covariances obtained by manually annotating sensor regimes. We also show that using the learned covariances during filtering provides substantial quantitative improvement to the overall state estimate. © 2013 IEEE.United States. National Aeronautics and Space AdministrationSiemens Corporate ResearchUnited States. Office of Naval Research. Multidisciplinary University Research InitiativeMicro Autonomous Consortium Systems and Technolog

Adaptive filtering applications to satellite navigation

PhDDifferential Global Navigation Satellite Systems employ the extended Kalman filter to estimate the reference position error. High accuracy integrated navigation systems have the ability to mix traditional inertial sensor outputs with navigation satellite based position information and can be used to develop high accuracy landing systems for aircraft. This thesis considers a host of estimation problems associated with aircraft navigation systems that currently rely on the extended Kalman filter and proposes to use a nonlinear estimation algorithm, the unscented Kalman filter (UKF) that does not rely on Jacobian linearisation. The objective is to develop high accuracy positioning algorithms to facilitate the use of GNSS or DGNSS for aircraft landing. Firstly, the position error in a typical satellite navigation problem depends on the accuracy of the orbital ephemeris. The thesis presents results for the prediction of the orbital ephemeris from a customised navigation satellite receiver's data message. The SDP4/SDP8 algorithms and suitable noise models are used to establish the measured data. Secondly, the differential station common mode position error not including the contribution due to errors in the ephemeris is usually estimated by employing an EKF. The thesis then considers the application of the UKF to the mixing problem, so as to facilitate the mixing of measurements made by either a GNSS or a DGNSS and a variety of low cost or high-precision INS sensors. Precise, adaptive UKFs and a suitable nonlinear propagation method are used to estimate the orbit ephemeris and the differential position and the navigation filter mixing errors. The results indicate the method is particularly suitable for estimating the orbit ephemeris of navigation satellites and the differential position and navigation filter mixing errors, thus facilitating interoperable DGNSS operation for aircraft landing

Suspended Load Path Tracking Control Using a Tilt-rotor UAV Based on Zonotopic State Estimation

This work addresses the problem of path tracking control of a suspended load using a tilt-rotor UAV. The main challenge in controlling this kind of system arises from the dynamic behavior imposed by the load, which is usually coupled to the UAV by means of a rope, adding unactuated degrees of freedom to the whole system. Furthermore, to perform the load transportation it is often needed the knowledge of the load position to accomplish the task. Since available sensors are commonly embedded in the mobile platform, information on the load position may not be directly available. To solve this problem in this work, initially, the kinematics of the multi-body mechanical system are formulated from the load's perspective, from which a detailed dynamic model is derived using the Euler-Lagrange approach, yielding a highly coupled, nonlinear state-space representation of the system, affine in the inputs, with the load's position and orientation directly represented by state variables. A zonotopic state estimator is proposed to solve the problem of estimating the load position and orientation, which is formulated based on sensors located at the aircraft, with different sampling times, and unknown-but-bounded measurement noise. To solve the path tracking problem, a discrete-time mixed $\mathcal{H}_2/\mathcal{H}_\infty$ controller with pole-placement constraints is designed with guaranteed time-response properties and robust to unmodeled dynamics, parametric uncertainties, and external disturbances. Results from numerical experiments, performed in a platform based on the Gazebo simulator and on a Computer Aided Design (CAD) model of the system, are presented to corroborate the performance of the zonotopic state estimator along with the designed controller

A survey on fractional order control techniques for unmanned aerial and ground vehicles

In recent years, numerous applications of science and engineering for modeling and control of unmanned aerial vehicles (UAVs) and unmanned ground vehicles (UGVs) systems based on fractional calculus have been realized. The extra fractional order derivative terms allow to optimizing the performance of the systems. The review presented in this paper focuses on the control problems of the UAVs and UGVs that have been addressed by the fractional order techniques over the last decade

Optimal slip control for tractors with feedback of drive torque

Traction efficiency of tractors barely reaches 50 % in field operations. On the other hand, modern trends in agriculture show growth of the global tractor markets and at the same time increased demands for greenhouse gas emission reduction as well as energy efficiency due to increasing fuel costs. Engine power of farm tractors is growing at 1.8 kW per year reaching today about 500 kW for the highest traction class machines. The problem of effective use of energy has become crucial. Existing slip control approaches for tractors do not fulfil this requirement due to fixed reference set-point. The present work suggests an optimal control scheme based on set-point optimization and on assessment of soil conditions, namely, wheel-ground parameter identification using fuzzy-logic-assisted adaptive unscented Kalman filter.:List of figures VIII List of tables IX Keywords XI List of abbreviations XII List of mathematical symbols XIII Indices XV 1 Introduction 1 1.1 Problem description and challenges 1 1.1.1 Development of agricultural industry 1 1.1.2 Power flows and energy efficiency of a farm tractor 2 1.2 Motivation 9 1.3 Purpose and approach 12 1.3.1 Purpose and goals 12 1.3.2 Brief description of methodology 14 1.3.2.1 Drive torque feedback 14 1.3.2.2 Measurement signals 15 1.3.2.3 Identification of traction parameters 15 1.3.2.4 Definition of optimal slip 15 1.4 Outline 16 2 State of the art in traction management and parameter estimation 17 2.1 Slip control for farm tractors 17 2.2 Acquisition of drive torque feedback 23 2.3 Tire-ground parameter estimation 25 2.3.1 Kalman filter 25 2.3.2 Extended Kalman filter 27 2.3.3 Unscented Kalman filter 27 2.3.4 Adaptation algorithms for Kalman filter 29 3 Modelling vehicle dynamics for traction control 31 3.1 Tire-soil interaction 31 3.1.1 Forces in wheel-ground contact 32 3.1.1.1 Vertical force 32 3.1.1.2 Tire-ground surface geometry 34 3.1.2 Longitudinal force 36 3.1.3 Zero-slip condition 37 3.1.3.1 Soil shear stress 38 3.1.3.2 Rolling resistance 39 3.2 Vehicle body and wheels 40 3.2.1 Short description of Multi-Body-Simulation 40 3.2.2 Vehicle body and wheel models 42 3.2.3 Wheel structure 43 3.3 Stochastic input signals 45 3.3.1 Influence of trend and low-frequency components 47 3.3.2 Modelling stochastic signals 49 3.4 Further components and general view of tractor model 53 3.4.1 Generator, intermediate circuit, electrical motors and braking resistor 53 3.4.2 Diesel engine 55 4 Identification of traction parameters 56 4.1 Description of identification approaches 56 4.2 Vehicle model 58 4.2.1 Vehicle longitudinal dynamics 58 4.2.2 Wheel rotational dynamics 59 4.2.3 Tire dynamic rolling radius and inner rolling resistance coefficient 60 4.2.4 Whole model 61 4.3 Static methods of parameter identification 63 4.4 Adaptation mechanism of the unscented Kalman filter 63 4.5 Fuzzy supervisor for the adaptive unscented Kalman filter 66 4.5.1 Structure of the fuzzy supervisor 67 4.5.2 Stability analysis of the adaptive unscented Kalman filter with the fuzzy supervisor 69 5 Optimal slip control 73 5.1 Approaches for slip control by means of traction control system 73 5.1.1 Feedback compensation law 73 5.1.2 Sliding mode control 74 5.1.3 Funnel control 77 5.1.4 Lyapunov-Candidate-Function-based control, other approaches and choice of algorithm 78 5.2 General description of optimal slip control algorithm 79 5.3 Estimation of traction force characteristic curves 82 5.4 Optimal slip set-point computation 85 6 Verification of identification and optimal slip control systems 91 6.1 Simulation results 91 6.1.1 Identification of traction parameters 91 6.1.1.1 Comparison of extended Kalman filter and unscented Kalman filter 92 6.1.1.2 Comparison of ordinary and adaptive unscented Kalman filters 96 6.1.1.3 Comparison of the adaptive unscented Kalman filter with the fuzzy supervisor and static methods 99 6.1.1.4 Description of soil conditions 100 6.1.1.5 Identification of traction parameters under changing soil conditions 101 6.1.2 Approximation of characteristic curves 102 6.1.3 Slip control with reference of 10% 103 6.1.4 Comparison of operating with fixed and optimal slip reference 104 6.2 Experimental verification 108 6.2.1 Setup and description of the experiments 108 6.2.2 Virtual slip control without load machine 109 6.2.3 Virtual slip control with load machine 113 7 Summary, conclusions and future challenges 122 7.1 Summary of results and discussion 122 7.2 Contributions of the dissertation 123 7.3 Future challenges 123 Bibliography 125 A Measurement systems 137 A.1 Measurement of vehicle velocity 137 A.2 Measurement of wheel speed 138 A.3 Measurement or estimation of wheel vertical load 139 A.4 Measurement of draft force 140 A.5 Further possible measurement systems 141 B Basic probability theoretical notions 142 B.1 Brief description of the theory of stochastic processes 142 B.2 Properties of stochastic signals 144 B.3 Bayesian filtering 145 C Modelling stochastic draft force and field microprofile 147 D Approximation of kappa-curves 152 E Simulation parameters 15

Adaptive and Optimal Motion Control of Multi-UAV Systems

This thesis studies trajectory tracking and coordination control problems for single and multi unmanned aerial vehicle (UAV) systems. These control problems are addressed for both quadrotor and fixed-wing UAV cases. Despite the fact that the literature has some approaches for both problems, most of the previous studies have implementation challenges on real-time systems. In this thesis, we use a hierarchical modular approach where the high-level coordination and formation control tasks are separated from low-level individual UAV motion control tasks. This separation helps efficient and systematic optimal control synthesis robust to effects of nonlinearities, uncertainties and external disturbances at both levels, independently. The modular two-level control structure is convenient in extending single-UAV motion control design to coordination control of multi-UAV systems. Therefore, we examine single quadrotor UAV trajectory tracking problems to develop advanced controllers compensating effects of nonlinearities and uncertainties, and improving robustness and optimality for tracking performance. At fi rst, a novel adaptive linear quadratic tracking (ALQT) scheme is developed for stabilization and optimal attitude control of the quadrotor UAV system. In the implementation, the proposed scheme is integrated with Kalman based reliable attitude estimators, which compensate measurement noises. Next, in order to guarantee prescribed transient and steady-state tracking performances, we have designed a novel backstepping based adaptive controller that is robust to effects of underactuated dynamics, nonlinearities and model uncertainties, e.g., inertial and rotational drag uncertainties. The tracking performance is guaranteed to utilize a prescribed performance bound (PPB) based error transformation. In the coordination control of multi-UAV systems, following the two-level control structure, at high-level, we design a distributed hierarchical (leader-follower) 3D formation control scheme. Then, the low-level control design is based on the optimal and adaptive control designs performed for each quadrotor UAV separately. As particular approaches, we design an adaptive mixing controller (AMC) to improve robustness to varying parametric uncertainties and an adaptive linear quadratic controller (ALQC). Lastly, for planar motion, especially for constant altitude flight of fixed-wing UAVs, in 2D, a distributed hierarchical (leader-follower) formation control scheme at the high-level and a linear quadratic tracking (LQT) scheme at the low-level are developed for tracking and formation control problems of the fixed-wing UAV systems to examine the non-holonomic motion case. The proposed control methods are tested via simulations and experiments on a multi-quadrotor UAV system testbed

Advanced Strategies for Robot Manipulators

Amongst the robotic systems, robot manipulators have proven themselves to be of increasing importance and are widely adopted to substitute for human in repetitive and/or hazardous tasks. Modern manipulators are designed complicatedly and need to do more precise, crucial and critical tasks. So, the simple traditional control methods cannot be efficient, and advanced control strategies with considering special constraints are needed to establish. In spite of the fact that groundbreaking researches have been carried out in this realm until now, there are still many novel aspects which have to be explored

Robust vision based slope estimation and rocks detection for autonomous space landers

As future robotic surface exploration missions to other planets, moons and asteroids become more ambitious in their science goals, there is a rapidly growing need to significantly enhance the capabilities of entry, descent and landing technology such that landings can be carried out with pin-point accuracy at previously inaccessible sites of high scientific value. As a consequence of the extreme uncertainty in touch-down locations of current missions and the absence of any effective hazard detection and avoidance capabilities, mission designers must exercise extreme caution when selecting candidate landing sites. The entire landing uncertainty footprint must be placed completely within a region of relatively flat and hazard free terrain in order to minimise the risk of mission ending damage to the spacecraft at touchdown. Consequently, vast numbers of scientifically rich landing sites must be rejected in favour of safer alternatives that may not offer the same level of scientific opportunity. The majority of truly scientifically interesting locations on planetary surfaces are rarely found in such hazard free and easily accessible locations, and so goals have been set for a number of advanced capabilities of future entry, descent and landing technology. Key amongst these is the ability to reliably detect and safely avoid all mission critical surface hazards in the area surrounding a pre-selected landing location. This thesis investigates techniques for the use of a single camera system as the primary sensor in the preliminary development of a hazard detection system that is capable of supporting pin-point landing operations for next generation robotic planetary landing craft. The requirements for such a system have been stated as the ability to detect slopes greater than 5 degrees and surface objects greater than 30cm in diameter. The primary contribution in this thesis, aimed at achieving these goals, is the development of a feature-based,self-initialising, fully adaptive structure from motion (SFM) algorithm based on a robust square-root unscented Kalman filtering framework and the fusion of the resulting SFM scene structure estimates with a sophisticated shape from shading (SFS) algorithm that has the potential to produce very dense and highly accurate digital elevation models (DEMs) that possess sufficient resolution to achieve the sensing accuracy required by next generation landers. Such a system is capable of adapting to potential changes in the external noise environment that may result from intermittent and varying rocket motor thrust and/or sudden turbulence during descent, which may translate to variations in the vibrations experienced by the platform and introduce varying levels of motion blur that will affect the accuracy of image feature tracking algorithms. Accurate scene structure estimates have been obtained using this system from both real and synthetic descent imagery, allowing for the production of accurate DEMs. While some further work would be required in order to produce DEMs that possess the resolution and accuracy needed to determine slopes and the presence of small objects such as rocks at the levels of accuracy required, this thesis presents a very strong foundation upon which to build and goes a long way towards developing a highly robust and accurate solution