Improvement of Robot’s Simultaneous Localization and Mapping Using an Effective Transformation to Achieve Linear Model

Seyed Farzad Bahreinian, Maziar Palhang, Mohammad Reza Taban, Hasan Enami Eraghi · 2026

Read Improvement of Robot’s Simultaneous Localization and Mapping Using an Effective Transformation to Achieve Linear Model by Seyed Farzad Bahreinian, Maziar Palhang, Mohammad Reza Taban, Hasan Enami Eraghi (2026) in the Tower of Babel, a free online library of public-domain works preserved in clean, searchable text. No sign-up. The full text is served as a plain-text file at a predictable URL, where text is present: https://antarctic-labs.com/tower-of-babel/arxiv-2606-28475.txt.

Introduction

Seyed Farzad Bahreinian, Maziar Palhang, Mohammad Reza Taban, and Hasan Enami Eraghi attack a chronic failure of robot mapping. Simultaneous localization and mapping, where a robot charts its surroundings while tracking its own position, usually runs on an extended Kalman filter. Nonlinear motion and observation models force approximations whose errors can make the whole estimate diverge.

Bahreinian and colleagues add a simple compass and apply a carefully chosen transformation that rewrites the nonlinear state-space model as a genuinely linear one. The plain Kalman filter then applies exactly, giving their LMKF SLAM method. They report it significantly outperforms state-of-the-art methods, especially extended-filter rivals, in accuracy, convergence, and computing cost, and stays steadier when sensor noise and system parameters vary. Experiments back the claims.

Catalog record

CREATORSeyed Farzad Bahreinian, Maziar Palhang, Mohammad Reza Taban, Hasan Enami Eraghi
YEAR2026
COLLECTIONPAPERS
FORMATTXT
FILE SIZE36 KB
LICENSEhttp://creativecommons.org/licenses/by/4.0/
RIGHTSCC BY
SOURCEarXiv

Source: https://arxiv.org/abs/2606.28475

Browse the full library · About the Tower of Babel

Full text

The opening of the work, from the library's hosted text:

Improvement of Robot’s Simultaneous Localization and Mapping Using an Effective Transformation to Achieve Linear Model Seyed Farzad Bahreinian, Maziar Palhang, Mohammad Reza Taban, Hasan Enami Eraghi Abstract Nowadays mobile robots have wide engineering applications. Simultaneous localization and mapping (SLAM) is an important task of these robots. The major and common algorithms used for this task are based on extended Kalman filter (EKF). One of the main problems in EKF-based SLAM is its divergence. The nonlinearity of motion and observation models and linearization error are the main reasons for the divergence. There have been some efforts to address this problem with limited success. In this paper, by applying a simple compass and using an effective transformation, we transform the non-linear state space model into a linear model. Then, by applying the original KF to this model, we reach a new method, which is called LMKF SLAM. We show that the LMKF SLAM is significantly superior to the state-of-the-art methods, especially EKF-based SLAMs, both in accuracy, convergence, and computational complexity. The proposed method is also more stable with respect to the uncertainty of sensors values and changes in system parameters. Experimental results verify these points. 1 1 footnotetext: Subsea Science and Technology Research Institute, Isfahan University of Technology, Isfahan, Iran 2 2 footnotetext: Department of Electrical and Computer Engineering, Isfahan University of Technology, Isfahan, Iran Keywords: Mobile Robots, SLAM, Linear model, Localization, Mapping 1 Introduction Robot localization is one of the main and fundamental concerns in mobile robot navigation. When a mobile robot is applied for a mission, it must be aware of its position in the environment. The accuracy of mobile robot positioning definitely affects its performance. Certainly, without precise localization, robots may be lost and cannot be successful in their duties. In some situations, the surrounding environment of the robot is unknown too. In these cases, the robot can use simultaneous localization and mapping (SLAM) techniques. In fact, the robot gradually makes the map which is the reference for positioning of the robot [ 10 ] . Two approaches have been proposed to implement SLAM: smoothing and filtering methods [ 11 , 12 ] . The smoothing methods are frequently offline and often require a primary graph map or sub-maps to produce the optimized map [ 21 , 25 ] . The filtering methods use sensors mounted on the robot, map the environment, and localize the robot just online. Among the filtering methods, the extended Kalman filter (EKF), extended information filter (EIF), sparse EIF, Fast SLAM, and particle filter (PF) are popular [ 8 , 24 ] . A well-known filtering method is Fast SLAM. In this algorithm, the particle filter is used to estimate the vehicle position, while the EKF is used to estimate the landmarks’ positions. A development of Fast SLAM is unscented Fast SLAM (UnFS) which is based on the scaled unscented transformation (SUT) [ 20 ] . The UnFS algorithm updates the mean and covariance of landmarks’ state vector by the Unscented filter to avoid linearization errors and Jacobian calculations in the estimation of landmark position. Chandra et. al proposed cubature Kalman filter (CKF) SLAM which does not require calculation of the Jacobian matrix during the prediction and update steps [ 7 ] , unlike the EKF. To overcome some drawbacks of CKF-SLAM such as low precision and poor stability, improved CKF (ICKF) SLAM has been presented [3], which uses information matrix in both prediction and update steps. The ICKF method is more accurate than the CKF-SLAM and is one of the best current filtering methods in SLAM. During the past two decades, considerable efforts have been performed to implement SLAM and overcome its challenges such as consistency and convergence. The convergence of robot and landmarks positioning in SLAM based on KF has been proved [ 9 ] . However, this proof is based on a rare assumption of the linearity of robot motion and observation models. Without these assumptions, the SLAM will be inconsistent and diverges especially in large environments with a high number of landmarks. So far, few efforts have been carried out on the SLAM convergence, and among them, only a limited number of effective solutions has been proposed to improve it. Julier et al. proved that even when the robot is stationary with no motion noise and by using bearing and range sensors, an inconsistent map will be produced by EKF-SLAM [ 19 ] . This means that landmarks’ positions are estimated incorrectly. This inconsistency is due to nonlinear motion and observation models. The linearization error increases the Kalman gain which then causes the estimated covariance matrix becomes less than its real value (reduction in uncertainty). Finally, this error causes incorrect state vector updating and jumps in robot and landmarks positions. Castellanos et al. confirmed that the main reason for the inconsistency of EKF-SLAM is linearization error. They improved the consistency of EKF-SLAM by using a series of independent local maps and limiting the inconsistency level during continuous improvement of maps [ 6 , 5 ] . Bailey et al. showed that the EKF-SLAM inconsistency very much depends on the estimation of the robot angle [ 2 ] . If the uncertainty in this angle estimation is more than one or two degrees, inconsistency in the map and robot localization will occur. Error in the robot angle estimation leads to error accumulation, and this causes the estimated map gets away from the real map. In large environments, this problem is inevitable. The conventional solutions such as adding noise stabilizer, using iterative-EKF or Unscented KF is not able to improve the inconsistency. If the variance of the robot angle is a small value, these inconsistencies grow slowly. Some researchers have even worked on the effects of the robot angle error estimation on upper and lower bounds of landmarks positioning error [ 23 , 15 , 17 ] . Huang et al. reviewed the inconsistency of the EKF-SLAM from the system observability point of view [ 16 ] . Their mathematical analysis showed that the error in the linearized model of the system state has the unobservable subspace of dimension two, while the error in the nonlinear model has three unobservable degrees of freedom related to the location and the robot angle in the global reference frame. This causes the incorrect estimation of filter throughput and inappropriate reduction of covariance matrix estimations. To solve it at first, they proposed a first-estimates Jacobian EKF (FEJ-EKF) method. In this method, the first-ever available estimates for all state variables are used in EKF Jacobian [ 13 ] . Then, they proposed another method called observability-constrained EKF (OC-EKF). In this approach, linearization points in EKF must be selected such that the expected errors are minimized according to observability constraints [ 14 ] . Meanwhile, some other researchers tried to investigate the effects of different parameters such as measurement noise and sampling time on EKF-SLAM consistency [ 18 , 22 ] ; nonetheless they did not propose any new approach to improve EKF-SLAM consistency or performance. Recently, Barrau et al. have presented an improved approach in OC-EKF method based on Invariant EKF (IEKF). They have used an appropriate non-linear estimation error that causes a better consistency in the SLAM

Read the complete text