├── .gitmodules ├── .vscode ├── c_cpp_properties.json └── settings.json ├── README.md ├── ekf_fusion ├── .vscode │ ├── c_cpp_properties.json │ └── settings.json ├── CMakeLists.txt ├── include │ └── EKF │ │ ├── PoseMeasurementModel.hpp │ │ ├── systemmodel.hpp │ │ └── utilities.hpp ├── package.xml └── src │ └── EKF.cpp ├── gtsam_imu ├── .vscode │ ├── c_cpp_properties.json │ └── settings.json ├── CMakeLists.txt ├── include │ └── gtsam_imu │ │ └── utilities.h ├── package.xml ├── scripts │ └── plot_graph.py └── src │ ├── Mestimators.cpp │ ├── imu_RTK.cpp │ ├── imu_RTK_fixlag.cpp │ ├── imu_preint.cpp │ └── imu_preint_sm.cpp └── image └── result_ekf.png /.gitmodules: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/Guo-ziwei/fusion/HEAD/.gitmodules -------------------------------------------------------------------------------- /.vscode/c_cpp_properties.json: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/Guo-ziwei/fusion/HEAD/.vscode/c_cpp_properties.json -------------------------------------------------------------------------------- /.vscode/settings.json: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/Guo-ziwei/fusion/HEAD/.vscode/settings.json -------------------------------------------------------------------------------- /README.md: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/Guo-ziwei/fusion/HEAD/README.md -------------------------------------------------------------------------------- /ekf_fusion/.vscode/c_cpp_properties.json: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/Guo-ziwei/fusion/HEAD/ekf_fusion/.vscode/c_cpp_properties.json -------------------------------------------------------------------------------- /ekf_fusion/.vscode/settings.json: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/Guo-ziwei/fusion/HEAD/ekf_fusion/.vscode/settings.json -------------------------------------------------------------------------------- /ekf_fusion/CMakeLists.txt: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/Guo-ziwei/fusion/HEAD/ekf_fusion/CMakeLists.txt -------------------------------------------------------------------------------- /ekf_fusion/include/EKF/PoseMeasurementModel.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/Guo-ziwei/fusion/HEAD/ekf_fusion/include/EKF/PoseMeasurementModel.hpp -------------------------------------------------------------------------------- /ekf_fusion/include/EKF/systemmodel.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/Guo-ziwei/fusion/HEAD/ekf_fusion/include/EKF/systemmodel.hpp -------------------------------------------------------------------------------- /ekf_fusion/include/EKF/utilities.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/Guo-ziwei/fusion/HEAD/ekf_fusion/include/EKF/utilities.hpp -------------------------------------------------------------------------------- /ekf_fusion/package.xml: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/Guo-ziwei/fusion/HEAD/ekf_fusion/package.xml -------------------------------------------------------------------------------- /ekf_fusion/src/EKF.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/Guo-ziwei/fusion/HEAD/ekf_fusion/src/EKF.cpp -------------------------------------------------------------------------------- /gtsam_imu/.vscode/c_cpp_properties.json: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/Guo-ziwei/fusion/HEAD/gtsam_imu/.vscode/c_cpp_properties.json -------------------------------------------------------------------------------- /gtsam_imu/.vscode/settings.json: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/Guo-ziwei/fusion/HEAD/gtsam_imu/.vscode/settings.json -------------------------------------------------------------------------------- /gtsam_imu/CMakeLists.txt: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/Guo-ziwei/fusion/HEAD/gtsam_imu/CMakeLists.txt -------------------------------------------------------------------------------- /gtsam_imu/include/gtsam_imu/utilities.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/Guo-ziwei/fusion/HEAD/gtsam_imu/include/gtsam_imu/utilities.h -------------------------------------------------------------------------------- /gtsam_imu/package.xml: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/Guo-ziwei/fusion/HEAD/gtsam_imu/package.xml -------------------------------------------------------------------------------- /gtsam_imu/scripts/plot_graph.py: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/Guo-ziwei/fusion/HEAD/gtsam_imu/scripts/plot_graph.py -------------------------------------------------------------------------------- /gtsam_imu/src/Mestimators.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/Guo-ziwei/fusion/HEAD/gtsam_imu/src/Mestimators.cpp -------------------------------------------------------------------------------- /gtsam_imu/src/imu_RTK.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/Guo-ziwei/fusion/HEAD/gtsam_imu/src/imu_RTK.cpp -------------------------------------------------------------------------------- /gtsam_imu/src/imu_RTK_fixlag.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/Guo-ziwei/fusion/HEAD/gtsam_imu/src/imu_RTK_fixlag.cpp -------------------------------------------------------------------------------- /gtsam_imu/src/imu_preint.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/Guo-ziwei/fusion/HEAD/gtsam_imu/src/imu_preint.cpp -------------------------------------------------------------------------------- /gtsam_imu/src/imu_preint_sm.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/Guo-ziwei/fusion/HEAD/gtsam_imu/src/imu_preint_sm.cpp -------------------------------------------------------------------------------- /image/result_ekf.png: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/Guo-ziwei/fusion/HEAD/image/result_ekf.png --------------------------------------------------------------------------------