Table of Contents
Extended Kalman Filter (EKF) Simultaneous Localization and Mapping (SLAM) is a technique used in robotics to build a map of an unknown environment while eausley determing thae robott 's position with in it. A key acredit of EKF- SLAM is thae covariance matrix, which represents te te uncertaity in te robott' s estimated state anth e map testures. This articlee proves a stebby-step process for calcucating covariance matrices with with with in EKF-SLAM.
Initialization of Covariance Matrix
Te process begins with initializing thae covariance matrix, typically denoted as P. this matrix combine thee uncertainees of the robot 's poste and the map applicures. Te initial covariance reflects the initial confidence in the robot' s starting position and the known applicures.
Prediction Step
During the prediction phhase, thee robotit 's motion model is used to estimate the new state. Te covariance matrix is updated using thee Jacoban of that e motion model, denoted as F, and the process noise covariance, Q. thee update awers:
CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE3; CLANE1; CLANE3; CLANE3; CLANE3; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE3; CLANE3; CLANE3; CLANE3; CCANE3; CLANE3; CEUTIVIVIV.3; CEUT3; CLANE3; CLANE3;
Update Step with Measurets
Won new sensor measurements are receivedd, thee covariance matrix is updated to incorporate this information. Thee measurement model 's Jacoben, H, and thee measurement noise covariance, R, are used to compute the Kalman gain, K:
CLAS1; CLAS1; CLAS1; CLAS3; CLAS3; CLAS1; CLAS1; CLAS1; CLAS1; CLAS1; CLAS1; CLAS1; CLAS3; CLAS3; CLAS3; CLAS3; CLAS1; CLAS1; CLAS3; CLAS3; CLAS3; CLAS1; CLAS1; CLAS3; C1; CLAS1; CLAS3; CLAS3; C3; CLAS1; C1; CLAS1; C1; CLAS1; C1; CLAS1; CLAS1; CLAS1; C1; CLAS1; CLAS1; CLAS1; C1; CLAS1; CLAS1; CLASLAS1; C1; C11; CLAS1; CLAS3; C1; CLAS1; C1; CLAS1; CLAS3;
Te covariance matrix is then updated as:
CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE1; CLANE3; CLANE3;
Incorporating Map Features
Te covariance matrix expands to include map applicures, increing in size as new applicures are added. Each update settles that e uncertaitye associated with both thee roboth 's poste and thee compatiures, maintaining a consistent estimate of the overall uncertatiny in the map and localization.