Motion, Unit Dual Quaternion and Motion Optimization

We introduce motions as real six-dimensional vectors. A motion means a rotation and a translation. We define a motion operator which maps unit dual quaternions to motions, and a UDQ operator which maps motions to unit dual quaternions. By these operators, we present the formulation of motion optimization, which is actually a real unconstrained optimization formulation. Then we formulate two classical problems in robot research, i.e., the hand-eye calibration problem and the simultaneous localization and mapping (SLAM) problem as motion optimization problems. This opens a new way to solve these problems via real unconstrained optimization

Robust UAV Position and Attitude Estimation using Multiple GNSS Receivers for Laser-based 3D Mapping

Small-sized unmanned aerial vehicles (UAVs) have been widely investigated for use in a variety of applications such as remote sensing and aerial surveying. Direct three-dimensional (3D) mapping using a small-sized UAV equipped with a laser scanner is required for numerous remote sensing applications. In direct 3D mapping, the precise information about the position and attitude of the UAV is necessary for constructing 3D maps. In this study, we propose a novel and robust technique for estimating the position and attitude of small-sized UAVs by employing multiple low-cost and light-weight global navigation satellite system (GNSS) antennas/receivers. Using the "redundancy" of multiple GNSS receivers, we enhance the performance of real-time kinematic (RTK)-GNSS by employing single-frequency GNSS receivers. This method consists of two approaches: hybrid GNSS fix solutions and consistency examination of the GNSS signal strength. The fix rate of RTK-GNSS using single-frequency GNSS receivers can be highly enhanced to combine multiple RTK-GNSS to fix solutions in the multiple antennas. In addition, positioning accuracy and fix rate can be further enhanced to detect multipath signals by using multiple GNSS antennas. In this study, we developed a prototype UAV that is equipped with six GNSS antennas/receivers. From the static test results, we conclude that the proposed technique can enhance the accuracy of the position and attitude estimation in multipath environments. From the flight test, the proposed system could generate a 3D map with an accuracy of 5 cm.Comment: Proceedings of IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) 201

Audio-based Localization for Swarms of Micro Air Vehicles

Localization is one of the key challenges that needs to be considered beforehand to design truly autonomous MAV teams. In this paper, we present a cooperative method to address the localization problem for a team of MAVs, where individuals obtain their position through perceiving a sound-emitting beacon MAV that is flying relative to a reference point in the environment. For this purpose, an on-board audio-based localization system is proposed that allows individuals to measure the relative bearing to the beacon robot and furthermore to localize themselves and the beacon robot simultaneously, without the need for a communication network. Our method is based on coherence testing among signals of a small on-board microphone array, to obtain the relative bearing measurements, and an estimator, to fuse these measurements with sensory information about the motion of the robot throughout time, to estimate robustly the MAV positions. The proposed method is evaluated both in simulation and in real world experiments

A Power Method for Computing the Dominant Eigenvalue of a Dual Quaternion Hermitian Matrix

In this paper, we first study the projections onto the set of unit dual quaternions, and the set of dual quaternion vectors with unit norms. Then we propose a power method for computing the dominant eigenvalue of a dual quaternion Hermitian matrix, and show its convergence and convergence rate under mild conditions. Based upon these, we reformulate the simultaneous localization and mapping (SLAM) problem as a rank-one dual quaternion completion problem. A two-block coordinate descent method is proposed to solve this problem. One block subproblem can be reduced to compute the best rank-one approximation of a dual quaternion Hermitian matrix, which can be computed by the power method. The other block has a closed-form solution. Numerical experiments are presented to show the efficiency of our proposed power method.Comment: 32 pages, 3 figure

Improving the Robustness of Monocular Vision-Aided Navigation for Multirotors through Integrated Estimation and Guidance

Multirotors could be used to autonomously perform tasks in search-and-rescue, reconnaissance, or infrastructure-monitoring applications. In these environments, the vehicle may have limited or degraded GPS access. Researchers have investigated methods for simultaneous localization and mapping (SLAM) using on-board vision sensors, allowing vehicles to navigate in GPS-denied environments. In particular, SLAM solutions based on a monocular camera offer low-cost, low-weight, and accurate navigation indoors and outdoors without explicit range limitations. However, a monocular camera is a bearing-only sensor. Additional sensors are required to achieve metric pose estimation, and the structure of a scene can only be recovered through camera motion. Because of these challenges, the performance of monocular-based navigation solutions is typically very sensitive to the environment and the vehicle’s trajectory. This work proposes an integrated estimation and guidance approach for improving the robustness of monocular SLAM to environmental uncertainty. It is specifically intended for a multirotor carrying a monocular camera, downward-facing rangefinder, and inertial measurement unit (IMU). A guidance maneuver is proposed that takes advantage of the metric rangefinder measurements. When the environmental uncertainty is high, the vehicle simply moves up and down, initializing features with a confident and accurate baseline. In order to demonstrate this technique, a vision-aided navigation solution is implemented which includes a unique approach to feature covariance initialization that is based on consider least squares. Features are only initialized if there is enough information to accurately triangulate their position, providing an indirect metric of environmental uncertainty that could be used to signal the guidance maneuver. The navigation filter is validated using hardware and simulated data. Finally, simulations show that the proposed initialization maneuver is a simple, practical, and effective way to improve the robustness of monocular-vision-aided-navigation and could increase the amount of autonomy that GPS-denied multirotors are capable of achieving

UAV Parameter Estimation with Gaussian Process Approximations

Unmanned Aerial Vehicles (UAVs) provide an alternative to manned aircraft for risk associated missions and applications where sizing constraints require miniaturized flying platforms. UAVs are currently utilised in an array of applications ranging from civilian research to military battlegrounds. A part of the development process for UAVs includes constructing a flight model. This model can be used for modern flight controller design and to develop high fidelity flight simulators. Furthermore, it also has a role in analysing stability, control and handling qualities of the platform. Developing such a model involves estimating stability and control parameters from flight data. These map the platform's control inputs to its dynamic response. The modeling process is labor intensive and requires coarse approximations. Similarly, models constructed through flight tests are only applicable to a narrow flight envelope and classical system identification approaches require prior knowledge of the model structure, which, in some instances may only be partially known. This thesis attempts to find a solution to these problems by introducing a new system identification method based on dependent Gaussian processes. The new method would allow for high fidelity non-linear flight dynamic models to be constructed through experimental data. The work is divided into two main components. The first part entails the development of an algorithm that captures cross coupling between input parameters, and learns the system stability and control derivatives. The algorithm also captures any dependencies embodied in the outputs. The second part focuses on reducing the heavy computational cost, which is a deterrent to learning the model from large test flight data sets. In addition, it explores the capabilities of the model to capture any non-stationary behavior in the aerodynamic coefficients. A modeling technique was developed that uses an additive sparse model to combine global and local Gaussian processes to learn a multi-output system. Having a combined approximation makes the model suitable for all regions of the flight envelope. In an attempt to capture the global properties, a new sampling method is introduced to gather information about the output correlations. Local properties were captured using a non-stationary covariance function with KD-trees for neighbourhood selection. This makes the model scalable to learn from high dimensional large-scale data sets. The thesis provides both theoretical underpinnings and practical applications of this approach. The theory was tested in simulation on a highly coupled oblique wing aircraft and was demonstrated on a delta-wing UAV platform using real flight data. The results were compared against an alternative parametric model and demonstrated robustness, improved identification of coupling between flight modes, sound ability to provide uncertainty estimates, and potential to be applied to a broader flight envelope

UAV Parameter Estimation with Gaussian Process Approximations

Unmanned Aerial Vehicles (UAVs) provide an alternative to manned aircraft for risk associated missions and applications where sizing constraints require miniaturized flying platforms. UAVs are currently utilised in an array of applications ranging from civilian research to military battlegrounds. A part of the development process for UAVs includes constructing a flight model. This model can be used for modern flight controller design and to develop high fidelity flight simulators. Furthermore, it also has a role in analysing stability, control and handling qualities of the platform. Developing such a model involves estimating stability and control parameters from flight data. These map the platform's control inputs to its dynamic response. The modeling process is labor intensive and requires coarse approximations. Similarly, models constructed through flight tests are only applicable to a narrow flight envelope and classical system identification approaches require prior knowledge of the model structure, which, in some instances may only be partially known. This thesis attempts to find a solution to these problems by introducing a new system identification method based on dependent Gaussian processes. The new method would allow for high fidelity non-linear flight dynamic models to be constructed through experimental data. The work is divided into two main components. The first part entails the development of an algorithm that captures cross coupling between input parameters, and learns the system stability and control derivatives. The algorithm also captures any dependencies embodied in the outputs. The second part focuses on reducing the heavy computational cost, which is a deterrent to learning the model from large test flight data sets. In addition, it explores the capabilities of the model to capture any non-stationary behavior in the aerodynamic coefficients. A modeling technique was developed that uses an additive sparse model to combine global and local Gaussian processes to learn a multi-output system. Having a combined approximation makes the model suitable for all regions of the flight envelope. In an attempt to capture the global properties, a new sampling method is introduced to gather information about the output correlations. Local properties were captured using a non-stationary covariance function with KD-trees for neighbourhood selection. This makes the model scalable to learn from high dimensional large-scale data sets. The thesis provides both theoretical underpinnings and practical applications of this approach. The theory was tested in simulation on a highly coupled oblique wing aircraft and was demonstrated on a delta-wing UAV platform using real flight data. The results were compared against an alternative parametric model and demonstrated robustness, improved identification of coupling between flight modes, sound ability to provide uncertainty estimates, and potential to be applied to a broader flight envelope

Single and multiple stereo view navigation for planetary rovers

© Cranfield UniversityThis thesis deals with the challenge of autonomous navigation of the ExoMars rover. The absence of global positioning systems (GPS) in space, added to the limitations of wheel odometry makes autonomous navigation based on these two techniques - as done in the literature - an inviable solution and necessitates the use of other approaches. That, among other reasons, motivates this work to use solely visual data to solve the robot’s Egomotion problem. The homogeneity of Mars’ terrain makes the robustness of the low level image processing technique a critical requirement. In the first part of the thesis, novel solutions are presented to tackle this specific problem. Detection of robust features against illumination changes and unique matching and association of features is a sought after capability. A solution for robustness of features against illumination variation is proposed combining Harris corner detection together with moment image representation. Whereas the first provides a technique for efficient feature detection, the moment images add the necessary brightness invariance. Moreover, a bucketing strategy is used to guarantee that features are homogeneously distributed within the images. Then, the addition of local feature descriptors guarantees the unique identification of image cues. In the second part, reliable and precise motion estimation for the Mars’s robot is studied. A number of successful approaches are thoroughly analysed. Visual Simultaneous Localisation And Mapping (VSLAM) is investigated, proposing enhancements and integrating it with the robust feature methodology. Then, linear and nonlinear optimisation techniques are explored. Alternative photogrammetry reprojection concepts are tested. Lastly, data fusion techniques are proposed to deal with the integration of multiple stereo view data. Our robust visual scheme allows good feature repeatability. Because of this, dimensionality reduction of the feature data can be used without compromising the overall performance of the proposed solutions for motion estimation. Also, the developed Egomotion techniques have been extensively validated using both simulated and real data collected at ESA-ESTEC facilities. Multiple stereo view solutions for robot motion estimation are introduced, presenting interesting benefits. The obtained results prove the innovative methods presented here to be accurate and reliable approaches capable to solve the Egomotion problem in a Mars environment