Stochastic Real-time Optimal Control: A Pseudospectral Approach for Bearing-Only Trajectory Optimization

A method is presented to couple and solve the optimal control and the optimal estimation problems simultaneously, allowing systems with bearing-only sensors to maneuver to obtain observability for relative navigation without unnecessarily detracting from a primary mission. A fundamentally new approach to trajectory optimization and the dual control problem is developed, constraining polynomial approximations of the Fisher Information Matrix to provide an information gradient and allow prescription of the level of future estimation certainty required for mission accomplishment. Disturbances, modeling deficiencies, and corrupted measurements are addressed with recursive updating of the target estimate with an Unscented Kalman Filter and the optimal path with Radau pseudospectral collocation methods and sequential quadratic programming. The basic real-time optimal control (RTOC) structure is investigated, specifically addressing limitations of current techniques in this area that lose error integration. The resulting guidance method can be applied to any bearing-only system, such as submarines using passive sonar, anti-radiation missiles, or small UAVs seeking to land on power lines for energy harvesting. Methods and tools required for implementation are developed, including variable calculation timing and tip-tail blending for potential discontinuities. Validation is accomplished with simulation and flight test, autonomously landing a quadrotor helicopter on a wire

Nonlinear bayesian filtering with applications to estimation and navigation

In principle, general approaches to optimal nonlinear filtering can be described in a unified way from the recursive Bayesian approach. The central idea to this recur- sive Bayesian estimation is to determine the probability density function of the state vector of the nonlinear systems conditioned on the available measurements. However, the optimal exact solution to this Bayesian filtering problem is intractable since it requires an infinite dimensional process. For practical nonlinear filtering applications approximate solutions are required. Recently efficient and accurate approximate non- linear filters as alternatives to the extended Kalman filter are proposed for recursive nonlinear estimation of the states and parameters of dynamical systems. First, as sampling-based nonlinear filters, the sigma point filters, the unscented Kalman fil- ter and the divided difference filter are investigated. Secondly, a direct numerical nonlinear filter is introduced where the state conditional probability density is calcu- lated by applying fast numerical solvers to the Fokker-Planck equation in continuous- discrete system models. As simulation-based nonlinear filters, a universally effective algorithm, called the sequential Monte Carlo filter, that recursively utilizes a set of weighted samples to approximate the distributions of the state variables or param- eters, is investigated for dealing with nonlinear and non-Gaussian systems. Recentparticle filtering algorithms, which are developed independently in various engineer- ing fields, are investigated in a unified way. Furthermore, a new type of particle filter is proposed by integrating the divided difference filter with a particle filtering framework, leading to the divided difference particle filter. Sub-optimality of the ap- proximate nonlinear filters due to unknown system uncertainties can be compensated by using an adaptive filtering method that estimates both the state and system error statistics. For accurate identification of the time-varying parameters of dynamic sys- tems, new adaptive nonlinear filters that integrate the presented nonlinear filtering algorithms with noise estimation algorithms are derived. For qualitative and quantitative performance analysis among the proposed non- linear filters, systematic methods for measuring the nonlinearities, biasness, and op- timality of the proposed nonlinear filters are introduced. The proposed nonlinear optimal and sub-optimal filtering algorithms with applications to spacecraft orbit es- timation and autonomous navigation are investigated. Simulation results indicate that the advantages of the proposed nonlinear filters make these attractive alterna- tives to the extended Kalman filter

A Highly Integrated Navigation Unit for On-Orbit Servicing Missions

VINAG (VISION/INS integrated Navigation Assisted by GNSS) is a highly integrated multisensor navigation unit, particularly conceived for On-Orbit Servicing missions. The system is designed to provide all-in-one, on-board real time autonomous absolute navigation as well as pose determination of an uncooperative known object orbiting in LEO (Low Earth Orbit), GEO (GEosynchronous Orbits) and possibly in HEO (Highly Earth Orbit). The system VINAG is under development by a team of Italian companies and universities, co-financed by the Italian Space Agency. Thanks to a tight optimized integration of its subsystems, VINAG is characterized by a low power and mass total budgets and therefore it is suitable for small and very small satellites. In order to provide both 1) absolute orbit and attitude determination and 2) vision-based pose determination, the unit integrates three metrology systems: a Cameras Subsystem (a monocular camera and a Star sensor), an Inertial Measurement Unit (IMU) and a GNSS (Global Navigation Satellite System) receiver. In this paper, we introduce the complete system architecture, the adopted algorithms and then the adopted hardware design solutions. In addition, we describe preliminary numerical simulation results obtained for different orbits from LEO to GEO carried out for the validation phase of VINAG

Adaptive Estimation and Heuristic Optimization of Nonlinear Spacecraft Attitude Dynamics

For spacecraft conducting on-orbit operations, changes to the structure of the spacecraft are not uncommon. These planned or unanticipated changes in inertia properties couple with the spacecraft\u27s attitude dynamics and typically require estimation. For systems with time-varying inertia parameters, multiple model adaptive estimation (MMAE) routines can be utilized for parameter and state estimates. MMAE algorithms involve constructing a bank of recursive estimators, each assuming a different hypothesis for the systems dynamics. This research has three distinct, but related, contributions to satellite attitude dynamics and estimation. In the first part of this research, MMAE routines employing parallel banks of unscented attitude filters are applied to analytical models of spacecraft with time-varying mass moments of inertia (MOI), with the objective of estimating the MOI and classifying the spacecraft\u27s behavior. New adaptive estimation techniques were either modified or developed that can detect discontinuities in MOI up to 98 of the time in the specific problem scenario.Second, heuristic optimization techniques and numerical methods are applied to Wahba\u27s single-frame attitude estimation problem,decreasing computation time by an average of nearly 67 . Finally, this research poses MOI estimation as an ODE parameter identification problem, achieving successful numerical estimates through shooting methods and exploiting the polhodes of rigid body motion with results, on average, to be within 1 to 5 of the true MOI values

Ultrasound-Augmented Laparoscopy

Laparoscopic surgery is perhaps the most common minimally invasive procedure for many diseases in the abdomen. Since the laparoscopic camera provides only the surface view of the internal organs, in many procedures, surgeons use laparoscopic ultrasound (LUS) to visualize deep-seated surgical targets. Conventionally, the 2D LUS image is visualized in a display spatially separate from that displays the laparoscopic video. Therefore, reasoning about the geometry of hidden targets requires mentally solving the spatial alignment, and resolving the modality differences, which is cognitively very challenging. Moreover, the mental representation of hidden targets in space acquired through such cognitive medication may be error prone, and cause incorrect actions to be performed. To remedy this, advanced visualization strategies are required where the US information is visualized in the context of the laparoscopic video. To this end, efficient computational methods are required to accurately align the US image coordinate system with that centred in the camera, and to render the registered image information in the context of the camera such that surgeons perceive the geometry of hidden targets accurately. In this thesis, such a visualization pipeline is described. A novel method to register US images with a camera centric coordinate system is detailed with an experimental investigation into its accuracy bounds. An improved method to blend US information with the surface view is also presented with an experimental investigation into the accuracy of perception of the target locations in space

Bio-inspired pressure sensing for active yaw control of underwater vehicles

Thesis (S.M.)--Massachusetts Institute of Technology, Dept. of Mechanical Engineering, 2013.Cataloged from PDF version of thesis.Includes bibliographical references (p. 89-92).A towed underwater vehicle equipped with a bio-inspired artificial lateral line (ALL) was constructed and tested with the goal of active detection and correction of the vehicle's yaw angle. Preliminary experiments demonstrate that a low number of sensors are sufficient to enable the discrimination between different orientations, and that a basic proportional controller is capable of keeping the vehicle aligned with the direction of flow. We propose that a model based controller could be developed to improve system response. Toward this, we derive a vehicle model based on a first-order 3D Rankine Source Panel Method, which is shown to be competent in estimating the pressure field in the region of interest during motion at constant angles, and during execution of dynamic maneuvers. To solve the inverse problem of estimating the vehicle orientation given specific pressure measurements, an Unscented Kalman Filter is developed around the model. It is shown to provide a close estimation of the vehicle state using experimentally collected pressure measurements. This demonstrates that an artificial lateral line is a promising technology for dynamically mediating the angle of a body relative to the oncoming flow.by Amy Gao.S.M

Localization using Distance Geometry : Minimal Solvers and Robust Methods for Sensor Network Self-Calibration

In this thesis, we focus on the problem of estimating receiver and sender node positions given some form of distance measurements between them. This kind of localization problem has several applications, e.g., global and indoor positioning, sensor network calibration, molecular conformations, data visualization, graph embedding, and robot kinematics. More concretely, this thesis makes contributions in three different areas.First, we present a method for simultaneously registering and merging maps. The merging problem occurs when multiple maps of an area have been constructed and need to be combined into a single representation. If there are no absolute references and the maps are in different coordinate systems, they also need to be registered. In the second part, we construct robust methods for sensor network self-calibration using both Time of Arrival (TOA) and Time Difference of Arrival (TDOA) measurements. One of the difficulties is that corrupt measurements, so-called outliers, are present and should be excluded from the model fitting. To achieve this, we use hypothesis-and-test frameworks together with minimal solvers, resulting in methods that are robust to noise, outliers, and missing data. Several new minimal solvers are introduced to accommodate a range of receiver and sender configurations in 2D and 3D space. These solvers are formulated as polynomial equation systems which are solvedusing methods from algebraic geometry.In the third part, we focus specifically on the problems of trilateration and multilateration, and we present a method that approximates the Maximum Likelihood (ML) estimator for different noise distributions. The proposed approach reduces to an eigendecomposition problem for which there are good solvers. This results in a method that is faster and more numerically stable than the state-of-the-art, while still being easy to implement. Furthermore, we present a robust trilateration method that incorporates a motion model. This enables the removal of outliers in the distance measurements at the same time as drift in the motion model is canceled

Advances in Simultaneous Localization and Mapping in Confined Underwater Environments Using Sonar and Optical Imaging.

This thesis reports on the incorporation of surface information into a probabilistic simultaneous localization and mapping (SLAM) framework used on an autonomous underwater vehicle (AUV) designed for underwater inspection. AUVs operating in cluttered underwater environments, such as ship hulls or dams, are commonly equipped with Doppler-based sensors, which---in addition to navigation---provide a sparse representation of the environment in the form of a three-dimensional (3D) point cloud. The goal of this thesis is to develop perceptual algorithms that take full advantage of these sparse observations for correcting navigational drift and building a model of the environment. In particular, we focus on three objectives. First, we introduce a novel representation of this 3D point cloud as collections of planar features arranged in a factor graph. This factor graph representation probabalistically infers the spatial arrangement of each planar segment and can effectively model smooth surfaces (such as a ship hull). Second, we show how this technique can produce 3D models that serve as input to our pipeline that produces the first-ever 3D photomosaics using a two-dimensional (2D) imaging sonar. Finally, we propose a model-assisted bundle adjustment (BA) framework that allows for robust registration between surfaces observed from a Doppler sensor and visual features detected from optical images. Throughout this thesis, we show methods that produce 3D photomosaics using a combination of triangular meshes (derived from our SLAM framework or given a-priori), optical images, and sonar images. Overall, the contributions of this thesis greatly increase the accuracy, reliability, and utility of in-water ship hull inspection with AUVs despite the challenges they face in underwater environments. We provide results using the Hovering Autonomous Underwater Vehicle (HAUV) for autonomous ship hull inspection, which serves as the primary testbed for the algorithms presented in this thesis. The sensor payload of the HAUV consists primarily of: a Doppler velocity log (DVL) for underwater navigation and ranging, monocular and stereo cameras, and---for some applications---an imaging sonar.PhDElectrical Engineering: SystemsUniversity of Michigan, Horace H. Rackham School of Graduate Studieshttp://deepblue.lib.umich.edu/bitstream/2027.42/120750/1/paulozog_1.pd