On the Covariance of ICP-based Scan-matching Techniques

This paper considers the problem of estimating the covariance of roto-translations computed by the Iterative Closest Point (ICP) algorithm. The problem is relevant for localization of mobile robots and vehicles equipped with depth-sensing cameras (e.g., Kinect) or Lidar (e.g., Velodyne). The closed-form formulas for covariance proposed in previous literature generally build upon the fact that the solution to ICP is obtained by minimizing a linear least-squares problem. In this paper, we show this approach needs caution because the rematching step of the algorithm is not explicitly accounted for, and applying it to the point-to-point version of ICP leads to completely erroneous covariances. We then provide a formal mathematical proof why the approach is valid in the point-to-plane version of ICP, which validates the intuition and experimental results of practitioners.Comment: Accepted at 2016 American Control Conferenc

Computational intelligence approaches to robotics, automation, and control [Volume guest editors]

No abstract available

Underwater & out of sight: towards ubiquity in underwater robotics

Submitted in partial fulfillment of the requirements for the degree of Doctor of Philosophy at the Massachusetts Institute of Technology and the Woods Hole Oceanographic Institution September 2019.The Earth's oceans holds a wealth of information currently hidden from us. Effective measurement of its properties could provide a better understanding of our changing climate and insights into the creatures that inhabit its waters. Autonomous underwater vehicles (AUVs) hold the promise of penetrating the ocean environment and uncovering its mysteries; and progress in underwater robotics research over the past three decades has resulted in vehicles that can navigate reliably and operate consistently, providing oceanographers with an additional tool for studying the ocean. Unfortunately, the high cost of these vehicles has stifled the democratization of this technology. We believe that this is a consequence of two factors. Firstly, reliable navigation on conventional AUVs has been achieved through the use of a sophisticated sensor system, namely the Doppler velocity log (DVL)-aided inertial navigation system (INS), which drives up vehicle cost, power use and size. Secondly, deployment of these vehicles is expensive and unwieldy due to their complexity, size and cost, resulting in the need for specialized personnel for vehicle operation and maintenance. The recent development of simpler, low-cost, miniature underwater robots provides a solution that mitigates both these factors; however, removing the expensive DVL-aided INS means that they perform poorly in terms of navigation accuracy. We address this by introducing a novel acoustic system that enables AUV self-localization without requiring a DVL-aided INS or on-board active acoustic transmitters. We term this approach Passive Inverted Ultra-Short Baseline (piUSBL) positioning. The system uses a single acoustic beacon and a time-synchronized, vehicle-mounted, passive receiver array to localize the vehicle relative to this beacon. Our approach has two unique advantages: first, a single beacon lowers cost and enables easy deployment; second, a passive receiver allows the vehicle to be low-power, low-cost and small, and enables multi-vehicle scalability. Providing this new generation of small and inexpensive vehicles with accurate navigation can potentially lower the cost of entry into underwater robotics research and further its widespread use for ocean science. We hope that these contributions in low-cost underwater navigation will enable the ubiquitous and coordinated use of robots to explore and understand the underwater domain.This research was funded and supported by a number of sponsors; we gratefully acknowledge them below. Defense Advanced Research Projects Agency (DARPA) and SSC Pacific via Applied Physical Sciences Corp. (APS) under contract number N66001-11-C-4115. SSC Pacific via Applied Physical Sciences Corp. (APS) under award number N66001-14-C-4031. Air Force via Lincoln Laboratory under award number FA8721-05-C-0002. Office of Naval Research (ONR) via University of California-San Diego under award number N00014-13-1-0632. Defense Advanced Research Projects Agency (DARPA) via Applied Physical Sciences Corp. (APS) under award number HR0011-18-C-0008. Office of Naval Research (ONR) under award number N00014-17-1-2474

Benelux meeting on systems and control, 23rd, March 17-19, 2004, Helvoirt, The Netherlands

Book of abstract

Path planning, flow estimation, and dynamic control for underwater vehicles

Underwater vehicles such as robotic fish and long-endurance ocean-sampling platforms operate in challenging fluid environments. This dissertation incorporates models of the fluid environment in the vehicles' guidance, navigation, and control strategies while addressing uncertainties associated with estimates of the environment's state. Coherent flow structures may be on the same spatial scale as the vehicle or substantially larger than the vehicle. This dissertation argues that estimation and control tasks across widely varying spatial scales, from vehicle-scale to long-range, may be addressed using common tools of empirical observability analysis, nonlinear/non-Gaussian estimation, and output-feedback control. As an application in vehicle-scale flow estimation and control, this dissertation details the design, fabrication, and testing of a robotic fish with an artificial lateral-line inspired by the lateral-line flow-sensing organ present in fish. The robotic fish is capable of estimating the flow speed and relative angle of the oncoming flow. Using symmetric and asymmetric sensor configurations, the robot achieves the primitive fish behavior called rheotaxis, which describes a fish's tendency to orient upstream. For long-range flow estimation and control, path planning may be accomplished using observability-based path planning, which evaluates a finite set of candidate control inputs using a measure related to flow-field observability and selects an optimizer over the set. To incorporate prior information, this dissertation derives an augmented observability Gramian using an optimal estimation strategy known as Incremental 4D-Var. Examination of the minimum eigenvalue of an empirical version of this Gramian yields a novel measure for path planning, called the empirical augmented unobservability index. Numerical experiments show that this measure correctly selects the most informative paths given the prior information. As an application in long-range flow estimation and control, this dissertation considers estimation of an idealized pair of ocean eddies by an adaptive Lagrangian sensor (i.e., a platform that uses its position data as measurements of the fluid transport, after accounting for its own control action). The adaptive sampling is accomplished using the empirical augmented unobservability index, which is extended to non-Gaussian posterior densities using an approximate expected-cost calculation. Output feedback recursively improves estimates of the vehicle position and flow-field states

Integrated perception, modeling, and control paradigm for bistatic sonar tracking by autonomous underwater vehicles

Thesis (Sc. D.)--Massachusetts Institute of Technology, Dept. of Mechanical Engineering, 2012.Cataloged from PDF version of thesis.Includes bibliographical references (p. 357-364).In this thesis, a fully autonomous and persistent bistatic anti-submarine warfare (ASW) surveillance solution is developed using the autonomous underwater vehicles (AUVs). The passive receivers are carried by these AUVs, and are physically separated from the cooperative active sources. These sources are assumed to be transmitting both the frequency-modulated (FM) and continuous wave (CW) sonar pulse signals. The thesis then focuses on providing novel methods for the AUVs/receivers to enhance the bistatic sonar tracking performance. Firstly, the surveillance procedure, called the Automated Perception, is developed to automatically abstract the sensed acoustical data from the passive receiver to the track report that represents the situation awareness. The procedure is executed sequentially by two algorithms: (i) the Sonar Signal Processing algorithm - built with a new dual-waveform fusion of the FM and CW signals to achieve reliable stream of contacts for improved tracking; and (ii) the Target Tracking algorithm - implemented by exploiting information and environmental adaptations to optimize tracking performance. Next, a vehicular control strategy, called the Perception-Driven Control, is devised to move the AUV in reaction to the track report provided by the Automated Perception. The thesis develops a new non-myopic and adaptive control for the vehicle. This is achieved by exploiting the predictive information and environmental rewards to optimize the future tracking performance. The formulation eventually leads to a new information-theoretic and environmental-based control. The main challenge of the surveillance solution then rests upon formulating a model that allows tracking performance to be enhanced via adaptive processing in the Automated Perception, and adaptive mobility by the Perception-Driven Control. A Unified Model is formulated in this thesis that amalgamates two models: (i) the Information-Theoretic Model - developed to define the manner at which the FM and CW acoustical, the navigational, and the environmental measurement uncertainties are propagated to the bistatic measurement uncertainties in the contacts; and (ii) the Environmental-Acoustic Model - built to predict the signal-to-noise power ratios (SNRs) of the FM and CW contacts. Explicit relationships are derived in this thesis using information theory to amalgamate these two models. Finally, an Integrated System is developed onboard each AUV that brings together all the above technologies to enhance the bistatic sonar tracking performance. The system is formulated as a closed-loop control system. This formulation provides a new Integrated Perception, Modeling, and Control Paradigm for an autonomous bistatic ASW surveillance solution using AUVs. The system is validated using the simulated data, and the real data collected from the Generic Littoral Interoperable Network Technology (GLINT) 2009 and 2010 experiments. The experiments were conducted jointly with the NATO Undersea Research Centre (NURC).by Raymond Hon Kit Lum.Sc.D

Computational intelligence approaches to robotics, automation, and control [Volume guest editors]

No abstract available