Visualize EKF State and covariance
run skf_slam.m
https://www.youtube.com/watch?v=XeWG5D71gC0&t=2097s
https://www.ipb.uni-bonn.de/html/teaching/photo12-2021/2021-pho2-16-ekf-slam.pptx.pdf

run ekf_ukf_eif.m
https://www.youtube.com/watch?v=DE6Jn2cB4J4&list=PLgnQpQtFTOGQrZ4O5QzbIHgl3b1JHimN_&index=5 https://www.youtube.com/watch?v=DWDzmweTKsQ&list=PLgnQpQtFTOGQrZ4O5QzbIHgl3b1JHimN_&index=7 https://www.youtube.com/watch?v=wD6BGkGOW4A&list=PLgnQpQtFTOGQrZ4O5QzbIHgl3b1JHimN_&index=8