For the SLAM system in robotics and autonomous driving, the accuracy of front-end odometry and back-end loop-closure detection determine the whole intelligent system performance. But the LiDAR-SLAM could be disturbed by current scene moving objects, resulting in drift errors and even loop-closure failure. Thus, the ability to detect and segment moving objects is essential for high-precision positioning and building a consistent map. In this paper, we address the problem of moving object segmentation from 3D LiDAR scans to improve the odometry and loop-closure accuracy of SLAM. We propose a novel 3D Sequential Moving-Object-Segmentation (3D-SeqMOS) method that can accurately segment the scene into moving and static objects, such as moving and static cars. Different from the existing projected-image method, we process the raw 3D point cloud and build a 3D convolution neural network for MOS task. In addition, to make full use of the spatio-temporal information of point cloud, we propose a point cloud residual mechanism using the spatial features of current scan and the temporal features of previous residual scans. Besides, we build a complete SLAM framework to verify the effectiveness and accuracy of 3D-SeqMOS. Experiments on SemanticKITTI dataset show that our proposed 3D-SeqMOS method can effectively detect moving objects and improve the accuracy of LiDAR odometry and loop-closure detection. The test results show our 3D-SeqMOS outperforms the existing state-of-the-art methods. We extend the proposed method to the SemanticKITTI: Moving Object Segmentation competition and achieve the 3rd in the leaderboard, showing its effectiveness.

In recent years, indoor positioning has drawn intensive attention for both pedestrian and mobile robot applications. Among various indoor positioning technologies, visible light positioning has many advantages due to its high localization accuracy, high bandwidth, energy efficiency, long lifetime, and cost efficiency. For postprocessing or semi-real-time applications, researchers often use smoothers to improve location accuracy. However, smoothers are always local estimators and lack integrity when calculating locations. To globally optimize the positioning results and further improve the accuracy, we propose a nonlinear optimization model based on the idea of graph optimization. Innovatively, the model adds the acceleration as a constraint to become one part of the residuals and regularize the trajectory. We design a signal-to-noise ratio-based weighting strategy to suppress the outliers and better assess the errors. Moreover, we design a loop constraint to further improve the positioning accuracy. The experimental results show that our proposed model significantly improves the accuracy by 71%, which is suitable for indoor positioning.

The rapid development of the Bluetooth technology offers a possible solution for indoor localization scenarios. Compared with other indoor localization technologies, such as vision, light detection and ranging, ultrawide band, etc., Bluetooth has been characterized by low cost, easy deployment, low energy consumption, and potentially high localization accuracy, which enable itself to be a competitive technology in indoor location-based services, the Internet of Things, and many other fields. In this article, we first present a comprehensive survey of Bluetooth localization technology, including the measurements for localization, working principles, and method comparison. We highlight the learning-based methods and integrated localization methods. Then, we review the applications and existing commercial solutions, revealing the possible directions for the industrialization of Bluetooth localization. Finally, this article proposes several open issues of Bluetooth localization (e.g., multichannel difference, multipath, co-channel interference, and device heterogeneity) and projects several future trends.

Camera–inertial measurement unit (IMU) sensor fusion has been extensively studied in recent decades. Numerous observability analysis and fusion schemes for motion estimation with self-calibration have been presented. However, it has been uncertain whether the intrinsic parameters of both the camera and the IMU are observable under general motion. To answer this question, by using the Lie derivatives, we first prove that for a rolling shutter (RS) camera–IMU system, all the intrinsic and extrinsic parameters, camera time offset, and readout time of the RS camera are observable with an unknown landmark. To our knowledge, we are the first to present such a proof. Next, to validate this analysis and to solve the drift issue of a structureless filter during standstills, we develop a keyframe-based sliding window filter (KSWF) for odometry and self-calibration, which works with a monocular RS camera or stereo RS cameras. Though the keyframe concept is widely used in vision-based sensor fusion, to our knowledge, the KSWF is the first of its kind to support self-calibration. Our simulation and real data tests have validated that it is possible to fully calibrate the camera–IMU system using the observations of opportunistic landmarks under diverse motion. Real data tests confirmed previous allusions that keeping landmarks in the state vector can remedy the drift in standstill and showed that the keyframe-based scheme is an alternative solution.

State estimation problems without absolute position measurements routinely arise in navigation of unmanned aerial vehicles, autonomous ground vehicles, etc., whose proper operation relies on accurate state estimates and reliable covariances. Unaware of absolute positions, these problems have immanent unobservable directions. Traditional causal estimators, however, usually gain spurious information on the unobservable directions, leading to over-confident covariance inconsistent with actual estimator errors. The consistency problem of fixed-lag smoothers (FLSs) has only been attacked by the first estimate Jacobian (FEJ) technique because of the complexity to analyze their observability property. But the FEJ has several drawbacks hampering its wide adoption. To ensure the consistency of a FLS, this paper introduces the right invariant error formulation into the FLS framework. To our knowledge, we are the first to analyze the observability of a FLS with the right invariant error. Our main contributions are twofold. As the first novelty, to bypass the complexity of analysis with the classic observability matrix, we show that observability analysis of FLSs can be done equivalently on the linearized system. Second, we prove that the inconsistency issue in the traditional FLS can be elegantly solved by the right invariant error formulation without artificially correcting Jacobians. By applying the proposed FLS to the monocular visual inertial simultaneous localization and mapping (SLAM) problem, we confirm that the method consistently estimates covariance similarly to a batch smoother in simulation and that our method achieved comparable accuracy as traditional FLSs on real data.