My implementations for filters used for state estimation and localization.
Currently has ekf implementation in C++ (branch- ekf). It is incomplete as of now.
TODO:
- Figure out how to call the prediction and update functions from the sensor callbacks.
- Add white guasssian noise in prediction cov. For this explore imu sdf files for, apparently they have gaussian noise ka functionality. Lidar had it, so should be there in imu as wel.
- To include parameter severs and yaml file (https://answers.ros.org/question/356580/how-are-yaml-files-used-in-ros/) (http://wiki.ros.org/roscpp/Overview/Parameter%20Server)
- Publish errors of the pose estimates and the gazebo odom so that we can judge the filter. Can use plotjuggler for this.