Abstract Precise estimation of position, velocity, and orientation is crucial for robust control in airborne applications such as the fast maneuvering power kites for airborne wind energy generators. In this paper we present a sensor fusion approach for the measurements of a global navigation satellite system receiver and an inertial measurement unit, using methods from direct optimal control. The resulting optimization problem is based on the minimization of the weighted squared residuals between model predictions and measurements and solved using a direct collocation discretization strategy. The framework allows the formulation of a batch and filter estimator which include beside the estimation of the navigational states the identification of sensor parameters such as biases of the inertial measurement unit. The results of the algorithms are evaluated against a reference trajectory of a maneuvering single propeller aircraft and achieve root mean squared errors below 1 m in position, 0.4 ms -1 in velocity, and 0.5 deg in orientation for the batch estimator. The contribution in this paper is a first step towards the required robustness of state estimation for airborne applications.
[1]
Jan Swevers,et al.
Spacecraft Attitude Estimation and Sensor Calibration Using Moving Horizon Estimation
,
2013
.
[2]
Aníbal Ollero,et al.
A Ground Control Station for a Multi-UAV Surveillance System
,
2013,
J. Intell. Robotic Syst..
[3]
Lorenz T. Biegler,et al.
On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programming
,
2006,
Math. Program..
[4]
Lorenz T. Biegler,et al.
Convergence rates for direct transcription of optimal control problems using collocation at Radau points
,
2008,
Comput. Optim. Appl..
[5]
Osamu Matsumoto,et al.
Research of Cargo UAV for civil transportation
,
2013
.
[6]
Tor Arne Johansen,et al.
Moving Horizon Estimation for Integrated Navigation Filtering
,
2015
.
[7]
P. Savage.
Strapdown Inertial Navigation Integration Algorithm Design Part 1: Attitude Algorithms
,
1998
.