├── CMakeLists.txt ├── README.md ├── config ├── doc │ └── image.png └── ouster64.yaml ├── include ├── Exp_mat.h ├── IKFoM_toolkit │ ├── esekfom │ │ ├── esekfom.hpp │ │ └── util.hpp │ └── mtk │ │ ├── build_manifold.hpp │ │ ├── src │ │ ├── SubManifold.hpp │ │ ├── mtkmath.hpp │ │ └── vectview.hpp │ │ ├── startIdx.hpp │ │ └── types │ │ ├── S2.hpp │ │ ├── SOn.hpp │ │ ├── vect.hpp │ │ └── wrapped_cv_mat.hpp ├── common │ ├── state.hpp │ ├── utils.hpp │ └── view.hpp ├── common_lib.h ├── estimator │ ├── ekf.hpp │ ├── estimator.hpp │ ├── kf.hpp │ ├── map.hpp │ ├── map_cs.hpp │ ├── map_g2o.hpp │ └── map_gtsam.hpp ├── fusion │ ├── factor.hpp │ ├── observer.hpp │ ├── predictor.hpp │ └── updator.hpp ├── ikd-Tree │ ├── README.md │ ├── ikd_Tree.cpp │ └── ikd_Tree.h ├── matplotlibcpp.h ├── radar_ego_velocity_estimator.h ├── rio_utils │ ├── data_types.h │ ├── math_helper.h │ ├── radar_point_cloud.h │ ├── ros_helper.h │ ├── simple_profiler.h │ └── strapdown.h ├── sensor │ ├── gnss.hpp │ ├── imu.hpp │ └── odom_6dof.hpp ├── so3_math.h ├── use-ikfom.hpp └── utility_radar.h ├── launch └── mapping_ouster64.launch ├── msg ├── Pose6D.msg ├── ScanMatchingStatus.msg ├── cloud_info.msg └── gps_info.msg ├── package.xml ├── rviz_cfg ├── .gitignore └── loam_livox.rviz └── src ├── AF_RLIO.cpp ├── GPS_Processing.cpp ├── IMU_Processing.hpp ├── LIDAR_Preprocess.cpp ├── Radar_Preprocess.cpp ├── preprocess.h └── radar_ego_velocity_estimator.cpp /CMakeLists.txt: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/CMakeLists.txt -------------------------------------------------------------------------------- /README.md: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/README.md -------------------------------------------------------------------------------- /config/doc/image.png: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/config/doc/image.png -------------------------------------------------------------------------------- /config/ouster64.yaml: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/config/ouster64.yaml -------------------------------------------------------------------------------- /include/Exp_mat.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/Exp_mat.h -------------------------------------------------------------------------------- /include/IKFoM_toolkit/esekfom/esekfom.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/IKFoM_toolkit/esekfom/esekfom.hpp -------------------------------------------------------------------------------- /include/IKFoM_toolkit/esekfom/util.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/IKFoM_toolkit/esekfom/util.hpp -------------------------------------------------------------------------------- /include/IKFoM_toolkit/mtk/build_manifold.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/IKFoM_toolkit/mtk/build_manifold.hpp -------------------------------------------------------------------------------- /include/IKFoM_toolkit/mtk/src/SubManifold.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/IKFoM_toolkit/mtk/src/SubManifold.hpp -------------------------------------------------------------------------------- /include/IKFoM_toolkit/mtk/src/mtkmath.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/IKFoM_toolkit/mtk/src/mtkmath.hpp -------------------------------------------------------------------------------- /include/IKFoM_toolkit/mtk/src/vectview.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/IKFoM_toolkit/mtk/src/vectview.hpp -------------------------------------------------------------------------------- /include/IKFoM_toolkit/mtk/startIdx.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/IKFoM_toolkit/mtk/startIdx.hpp -------------------------------------------------------------------------------- /include/IKFoM_toolkit/mtk/types/S2.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/IKFoM_toolkit/mtk/types/S2.hpp -------------------------------------------------------------------------------- /include/IKFoM_toolkit/mtk/types/SOn.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/IKFoM_toolkit/mtk/types/SOn.hpp -------------------------------------------------------------------------------- /include/IKFoM_toolkit/mtk/types/vect.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/IKFoM_toolkit/mtk/types/vect.hpp -------------------------------------------------------------------------------- /include/IKFoM_toolkit/mtk/types/wrapped_cv_mat.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/IKFoM_toolkit/mtk/types/wrapped_cv_mat.hpp -------------------------------------------------------------------------------- /include/common/state.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/common/state.hpp -------------------------------------------------------------------------------- /include/common/utils.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/common/utils.hpp -------------------------------------------------------------------------------- /include/common/view.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/common/view.hpp -------------------------------------------------------------------------------- /include/common_lib.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/common_lib.h -------------------------------------------------------------------------------- /include/estimator/ekf.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/estimator/ekf.hpp -------------------------------------------------------------------------------- /include/estimator/estimator.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/estimator/estimator.hpp -------------------------------------------------------------------------------- /include/estimator/kf.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/estimator/kf.hpp -------------------------------------------------------------------------------- /include/estimator/map.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/estimator/map.hpp -------------------------------------------------------------------------------- /include/estimator/map_cs.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/estimator/map_cs.hpp -------------------------------------------------------------------------------- /include/estimator/map_g2o.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/estimator/map_g2o.hpp -------------------------------------------------------------------------------- /include/estimator/map_gtsam.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/estimator/map_gtsam.hpp -------------------------------------------------------------------------------- /include/fusion/factor.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/fusion/factor.hpp -------------------------------------------------------------------------------- /include/fusion/observer.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/fusion/observer.hpp -------------------------------------------------------------------------------- /include/fusion/predictor.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/fusion/predictor.hpp -------------------------------------------------------------------------------- /include/fusion/updator.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/fusion/updator.hpp -------------------------------------------------------------------------------- /include/ikd-Tree/README.md: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/ikd-Tree/README.md -------------------------------------------------------------------------------- /include/ikd-Tree/ikd_Tree.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/ikd-Tree/ikd_Tree.cpp -------------------------------------------------------------------------------- /include/ikd-Tree/ikd_Tree.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/ikd-Tree/ikd_Tree.h -------------------------------------------------------------------------------- /include/matplotlibcpp.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/matplotlibcpp.h -------------------------------------------------------------------------------- /include/radar_ego_velocity_estimator.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/radar_ego_velocity_estimator.h -------------------------------------------------------------------------------- /include/rio_utils/data_types.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/rio_utils/data_types.h -------------------------------------------------------------------------------- /include/rio_utils/math_helper.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/rio_utils/math_helper.h -------------------------------------------------------------------------------- /include/rio_utils/radar_point_cloud.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/rio_utils/radar_point_cloud.h -------------------------------------------------------------------------------- /include/rio_utils/ros_helper.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/rio_utils/ros_helper.h -------------------------------------------------------------------------------- /include/rio_utils/simple_profiler.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/rio_utils/simple_profiler.h -------------------------------------------------------------------------------- /include/rio_utils/strapdown.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/rio_utils/strapdown.h -------------------------------------------------------------------------------- /include/sensor/gnss.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/sensor/gnss.hpp -------------------------------------------------------------------------------- /include/sensor/imu.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/sensor/imu.hpp -------------------------------------------------------------------------------- /include/sensor/odom_6dof.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/sensor/odom_6dof.hpp -------------------------------------------------------------------------------- /include/so3_math.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/so3_math.h -------------------------------------------------------------------------------- /include/use-ikfom.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/use-ikfom.hpp -------------------------------------------------------------------------------- /include/utility_radar.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/include/utility_radar.h -------------------------------------------------------------------------------- /launch/mapping_ouster64.launch: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/launch/mapping_ouster64.launch -------------------------------------------------------------------------------- /msg/Pose6D.msg: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/msg/Pose6D.msg -------------------------------------------------------------------------------- /msg/ScanMatchingStatus.msg: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/msg/ScanMatchingStatus.msg -------------------------------------------------------------------------------- /msg/cloud_info.msg: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/msg/cloud_info.msg -------------------------------------------------------------------------------- /msg/gps_info.msg: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/msg/gps_info.msg -------------------------------------------------------------------------------- /package.xml: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/package.xml -------------------------------------------------------------------------------- /rviz_cfg/.gitignore: -------------------------------------------------------------------------------- 1 | -------------------------------------------------------------------------------- /rviz_cfg/loam_livox.rviz: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/rviz_cfg/loam_livox.rviz -------------------------------------------------------------------------------- /src/AF_RLIO.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/src/AF_RLIO.cpp -------------------------------------------------------------------------------- /src/GPS_Processing.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/src/GPS_Processing.cpp -------------------------------------------------------------------------------- /src/IMU_Processing.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/src/IMU_Processing.hpp -------------------------------------------------------------------------------- /src/LIDAR_Preprocess.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/src/LIDAR_Preprocess.cpp -------------------------------------------------------------------------------- /src/Radar_Preprocess.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/src/Radar_Preprocess.cpp -------------------------------------------------------------------------------- /src/preprocess.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/src/preprocess.h -------------------------------------------------------------------------------- /src/radar_ego_velocity_estimator.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/QCL0920/AF-RLIO/HEAD/src/radar_ego_velocity_estimator.cpp --------------------------------------------------------------------------------