Localization and tracking are two very active areas of research for robotics, automation, and the Internet-of-Things. Accurate tracking for a large number of devices usually requires deployment of substantial infrastructure (infrared tracking systems, cameras, wireless antennas, etc.), which is not ideal for inaccessible or protected environments. This paper stems from the challenge posed such environments: cover a large number of units spread over a large number of small rooms, with minimal required localization infrastructure. The idea is to accurately track the position of handheld devices or mobile robots, without interfering with its architecture. Using Ultra-Wide Band (UWB) devices, we leveraged our expertise in distributed and collaborative robotic systems to develop an novel solution requiring a minimal number of fixed anchors. We discuss a strategy to share the UWB network together with an Extended Kalman filter derivation to collaboratively locate and track UWB-equipped devices, and show results from our experimental campaign tracking visitors in the Chambord castle in France.
@cite_10 considered the IMU as the process input and they derived a non-linear process noise including bias. Merging the Ubisense (UWB) measurement with a low-cost IMU, they showed that the localization accuracy can be improved. @cite_8 used the IMU to estimate the drag force of quadcopters and input this measure into their EKF, together with measurements from a custom UWB radio. These examples demonstrate the high accuracy ( @math cm) of their strategy. For a collaborative strategy on multi-agent localization, the work of Prorok and Martinoli @cite_18 reached comparable accuracy ( @math cm) modeling the UWB measurement error and compensating it with relative positioning between the robots (a separated module based on infrared). Instead of an EKF, they used a particle filter, also rather commonly used with UWB. A recent study on the collaborative use of UWB showed that two-way-ranging can give better results than simple time-difference of arrival @cite_12 . Their results confirmed our design choices, as previous setup conducted with a fixed transmission scheme (not dynamic) and the tags position computed on a central computer. Finally, the design of our EKF was inspired by previous works that focused on tracking a single UWB tag @cite_19 @cite_3 .
@cite_18 @cite_8 @cite_3 @cite_19 @cite_10 @cite_12
2056358962 2056842608 2114384289 1960629836
In this paper, we focus on the problem of motion tracking in unknown environments using visual and inertial sensors. We term this estimation task visual-inertial odometry (VIO), in analogy to the well-known visual-odometry problem. We present a detailed study of extended Kalman filter (EKF)-based VIO algorithms, by comparing both their theoretical properties and empirical performance. We show that an EKF formulation where the state vector comprises a sliding window of poses (the multi-state-constraint Kalman filter (MSCKF)) attains better accuracy, consistency, and computational efficiency than the simultaneous localization and mapping (SLAM) formulation of the EKF, in which the state vector contains the current pose and the features seen by the camera. Moreover, we prove that both types of EKF approaches are inconsistent, due to the way in which Jacobians are computed. Specifically, we show that the observability properties of the EKF's linearized system models do not match those of the underlying system, which causes the filters to underestimate the uncertainty in the state estimates. Based on our analysis, we propose a novel, real-time EKF-based VIO algorithm, which achieves consistent estimation by (i) ensuring the correct observability properties of its linearized system model, and (ii) performing online estimation of the camera-to-inertial measurement unit (IMU) calibration parameters. This algorithm, which we term MSCKF 2.0, is shown to achieve accuracy and consistency higher than even an iterative, sliding-window fixed-lag smoother, in both Monte Carlo simulations and real-world testing. Ultra-wideband (UWB) localization is a recent technology that performs competitively with many indoor localization methods currently available. Despite its desirable traits, such as potential high accuracy and high material penetrability, the resolution of non-line-of-sight signals remains a very hard problem and has a significant impact on the localization performance. In this work, we address the peculiarities of UWB error behavior by building models that capture the spatiality as well as the multimodal statistics of the error behavior. Our framework utilizes tessellated maps that associate probabilistic error models to localities in space. In addition to our UWB localization strategy (which provides absolute position estimates), we investigate the effects of collaboration in the form of relative positioning. To this end, we develop a relative range and bearing model and, together with the UWB model, present a unified localization technique based on a particle filter framework. We test our approach experimentally on a group of 10 mobile robots equipped with UWB emitters and extension modules providing inter-robot relative range and bearing measurements. Our experimental insights highlight the benefits of collaboration, which are consistent over numerous experimental scenarios. Also, we show the relevance, in terms of positioning accuracy, of our multimodal UWB measurement model by performing systematic comparisons with two alternative measurement models. Our final results show median localization errors below 10 cm in cluttered environments, using a modest set of 50 particles in our filter. In this paper we present a state estimation method based on an inertial measurement unit (IMU) and a planar laser range finder suitable for use in real-time on a fixed-wing micro air vehicle (MAV). The algorithm is capable of maintaing accurate state estimates during aggressive flight in unstructured 3D environments without the use of an external positioning system. Our localization algorithm is based on an extension of the Gaussian Particle Filter. We partition the state according to measurement independence relationships and then calculate a pseudo-linear update which allows us to use 20x fewer particles than a naive implementation to achieve similar accuracy in the state estimate. We also propose a multi-step forward fitting method to identify the noise parameters of the IMU and compare results with and without accurate position measurements. Our process and measurement models integrate naturally with an exponential coordinates representation of the attitude uncertainty. We demonstrate our algorithms experimentally on a fixed-wing vehicle flying in a challenging indoor environment. For the control of unmanned aerial vehicles UAVs in GPS-denied environments, cameras have been widely exploited as the main sensory modality for addressing the UAV state estimation problem. However, the use of visual information for ego-motion estimation presents several theoretical and practical difficulties, such as data association, occlusions, and lack of direct metric information when exploiting monocular cameras. In this paper, we address these issues by considering a quadrotor UAV equipped with an onboard monocular camera and an inertial measurement unit IMU. First, we propose a robust ego-motion estimation algorithm for recovering the UAV scaled linear velocity and angular velocity from optical flow by exploiting the so-called continuous homography constraint in the presence of planar scenes. Then, we address the problem of retrieving the unknown metric scale by fusing the visual information with measurements from the onboard IMU. To this end, two different estimation strategies are proposed and critically compared: a first exploiting the classical extended Kalman filter EKF formulation, and a second one based on a novel nonlinear estimation framework. The main advantage of the latter scheme lies in the possibility of imposing a desired transient response to the estimation error when the camera moves with a constant acceleration norm with respect to the observed plane. We indeed show that, when compared against the EKF on the same trajectory and sensory data, the nonlinear scheme yields considerably superior performance in terms of convergence rate and predictability of the estimation. The paper is then concluded by an extensive experimental validation, including an onboard closed-loop control of a real quadrotor UAV meant to demonstrate the robustness of our approach in real-world conditions.