Jacob M. Hartzer

This thesis summarizes the development of a collaborative localization algorithm simulation environment and the implementation of collaborative localization using Ultra-Wideband ranging in autonomous vehicles. In the developed simulation environment, multi-vehicle scenarios are testable with various sensor combinations and configurations. The simulation emulates the networking required for collaborative localization and serves as a platform for evaluating algorithm performance using Monte Carlo analysis. Monte-Carlo simulations were run using a number of situations and vehicles to test the efficacy of UWB sensors in decentralized collaborative localization as well as landmark measurements within an extended Kalman filter. Improvements from adding Ultra-Wideband ranging were shown in all simulated environments, with landmarks offering additional improvements to collaborative localization, and with the most significant accuracy improvements seen in GNSS-denied environments. Physical experiments were run using a by-wire GEM e6 from Autonomous Stuff in an urban environment in both collaborative and landmark setups. Due to higher than expected INS certainty, adding UWB measurements showed smaller improvements than simulations. Improvements of 9.2 to 12.1% were shown through the introduction of Ultra-Wideband ranging measurements in a decentralized collaborative localization algorithm. Improvements of 30.6 to 83.3% were shown in using UWB ranging measurements to landmarks in an Extended Kalman Filter for street crossing and tunnel environments respectively. These results are similar to the simulated data, and are promising in showing the efficacy of adding UWB ranging sensors to cars for collaborative and landmark localization, especially in GNSS-denied environments. In the future, additional moving vehicles with additional tags will be tested and further evaluations of the UWB ranging modules will be performed.

This work presents a centralized multi-IMU filter framework with online intrinsic and extrinsic calibration for unsynchronized inertial measurement units that is robust against changes in calibration parameters. The novel EKF-based method estimates the positional and rotational offsets of the system of sensors as well as their intrinsic biases without the use of rigid body geometric constraints. Additionally, the filter is flexible in the total number of sensors used while leveraging the commonly used MSCKF framework for camera measurements. The filter framework has been validated using Monte Carlo simulation as well as experimentally. In both simulations and experiments, using multiple IMU measurement streams within the proposed filter framework outperforms the use of a single IMU in a filter prediction step while also producing consistent and accurate estimates of initial calibration errors. Compared to current state-of-the-art optimizers, the filter produces similar intrinsic and extrinsic calibration parameters for each sensor. Finally, an open source repository has been provided at this https URL containing both the online estimator and the simulation used for testing and evaluation.

Visual-inertial navigation systems are powerful in their ability to accurately estimate localization of mobile systems within complex environments that preclude the use of global navigation satellite systems. However, these navigation systems are reliant on accurate and up-to-date temporospatial calibrations of the sensors being used. As such, online estimators for these parameters are useful in resilient systems. This paper presents an extension to existing Kalman Filter based frameworks for estimating and calibrating the extrinsic parameters of multi-camera IMU systems. In addition to extending the filter framework to include multiple camera sensors, the measurement model was reformulated to make use of measurement data that is typically made available in fiducial detection software. A secondary filter layer was used to estimate time translation parameters without closed-loop feedback of sensor data. Experimental calibration results, including the use of cameras with non-overlapping fields of view, were used to validate the stability and accuracy of the filter formulation when compared to offline methods. Finally the generalized filter code has been open-sourced and is available online.