roman-smirnov / kalman

C++ sensor fusion extended kalman filter implementation with eigen, json, uwebsockets libraries

Geek Repo:Geek Repo

Github PK Tool:Github PK Tool

Extended Kalman Filter Project

This project implements a rudimentary sensor fusion module which estimates the position of a vehicle (2d, top-down) from mock Lidar and Radar sensor data. The fusion module includes an implementation of a standard (linear) Kalman filter to handle Lidar data and a linearized (extended) Kalman filter to handle Radar data. The RMSE metric is used to evaluate estimator performance.

Screen Shot 2019-02-27 at 20.14.05

Screen Shot 2019-02-27 at 20.13.44

Data

./data/obj_pose-laser-radar-synthetic-input.txt

L	3.122427e-01	5.803398e-01	1477010443000000	6.000000e-01	6.000000e-01	5.199937e+00	0	0	6.911322e-03
R	1.014892e+00	5.543292e-01	4.892807e+00	1477010443050000	8.599968e-01	6.000449e-01	5.199747e+00	1.796856e-03	3.455661e-04	1.382155e-02
...
  • timestamp is in microseconds
  • radar data is in polar coordinates

Resources

Reference Projects

About

C++ sensor fusion extended kalman filter implementation with eigen, json, uwebsockets libraries


Languages

Language:C++ 99.6%Language:CMake 0.4%