├── CMakeLists.txt ├── LICENSE ├── README.md ├── apps ├── preprocessing_nodelet.cpp ├── radar_graph_slam_nodelet.cpp └── scan_matching_odometry_nodelet.cpp ├── cmake └── FindG2O.cmake ├── config └── params.yaml ├── doc ├── fig_carpark_map.png ├── fig_flowchart_4dradarslam.png ├── fig_flowchart_system.png ├── fig_map_compare.png └── mapping_smoke.gif ├── include ├── dbscan │ ├── DBSCAN_kdtree.h │ ├── DBSCAN_precomp.h │ └── DBSCAN_simple.h ├── g2o │ ├── edge_plane_identity.hpp │ ├── edge_plane_parallel.hpp │ ├── edge_plane_prior.hpp │ ├── edge_se3_gt_utm.hpp │ ├── edge_se3_plane.hpp │ ├── edge_se3_priorquat.hpp │ ├── edge_se3_priorvec.hpp │ ├── edge_se3_priorxy.hpp │ ├── edge_se3_priorxyz.hpp │ ├── edge_se3_priorz.hpp │ ├── edge_se3_se3.hpp │ ├── edge_se3_z.hpp │ └── robust_kernel_io.hpp ├── radar_ego_velocity_estimator.h ├── radar_graph_slam │ ├── graph_slam.hpp │ ├── information_matrix_calculator.hpp │ ├── keyframe.hpp │ ├── keyframe_updater.hpp │ ├── loop_detector.hpp │ ├── map_cloud_generator.hpp │ ├── nmea_sentence_parser.hpp │ ├── polynomial_interpolation.hpp │ ├── registrations.hpp │ ├── ros_time_hash.hpp │ └── ros_utils.hpp ├── rio_utils │ ├── data_types.h │ ├── math_helper.h │ ├── radar_point_cloud.h │ ├── ros_helper.h │ ├── simple_profiler.h │ └── strapdown.h ├── scan_context │ ├── KDTreeVectorOfVectorsAdaptor.h │ ├── Scancontext.h │ ├── nanoflann.hpp │ └── tictoc.h └── utility_radar.h ├── launch ├── radar_graph_slam.launch ├── rosbag_play_radar_carpark1.launch ├── rosbag_play_radar_carpark3.launch ├── rosbag_play_radar_garden.launch ├── rosbag_play_radar_nanyanglink.launch ├── rosbag_play_radar_ntuloop1.launch ├── rosbag_play_radar_ntuloop2.launch ├── rosbag_play_radar_ntuloop3.launch └── rosbag_play_radar_smoke.launch ├── msg ├── FloorCoeffs.msg └── ScanMatchingStatus.msg ├── nodelet_plugins.xml ├── package.xml ├── rviz └── radar_graph_slam.rviz ├── setup.py ├── src ├── g2o │ └── robust_kernel_io.cpp ├── gps_traj_align.cpp ├── gt_adjust.cpp ├── radar_ego_velocity_estimator.cpp └── radar_graph_slam │ ├── Scancontext.cpp │ ├── __init__.py │ ├── bag_player.py │ ├── ford2bag.py │ ├── graph_slam.cpp │ ├── information_matrix_calculator.cpp │ ├── keyframe.cpp │ ├── loop_detector.cpp │ ├── map2odom_publisher.py │ ├── map_cloud_generator.cpp │ └── registrations.cpp └── srv ├── DumpGraph.srv └── SaveMap.srv /CMakeLists.txt: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/CMakeLists.txt -------------------------------------------------------------------------------- /LICENSE: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/LICENSE -------------------------------------------------------------------------------- /README.md: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/README.md -------------------------------------------------------------------------------- /apps/preprocessing_nodelet.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/apps/preprocessing_nodelet.cpp -------------------------------------------------------------------------------- /apps/radar_graph_slam_nodelet.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/apps/radar_graph_slam_nodelet.cpp -------------------------------------------------------------------------------- /apps/scan_matching_odometry_nodelet.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/apps/scan_matching_odometry_nodelet.cpp -------------------------------------------------------------------------------- /cmake/FindG2O.cmake: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/cmake/FindG2O.cmake -------------------------------------------------------------------------------- /config/params.yaml: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/config/params.yaml -------------------------------------------------------------------------------- /doc/fig_carpark_map.png: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/doc/fig_carpark_map.png -------------------------------------------------------------------------------- /doc/fig_flowchart_4dradarslam.png: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/doc/fig_flowchart_4dradarslam.png -------------------------------------------------------------------------------- /doc/fig_flowchart_system.png: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/doc/fig_flowchart_system.png -------------------------------------------------------------------------------- /doc/fig_map_compare.png: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/doc/fig_map_compare.png -------------------------------------------------------------------------------- /doc/mapping_smoke.gif: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/doc/mapping_smoke.gif -------------------------------------------------------------------------------- /include/dbscan/DBSCAN_kdtree.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/dbscan/DBSCAN_kdtree.h -------------------------------------------------------------------------------- /include/dbscan/DBSCAN_precomp.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/dbscan/DBSCAN_precomp.h -------------------------------------------------------------------------------- /include/dbscan/DBSCAN_simple.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/dbscan/DBSCAN_simple.h -------------------------------------------------------------------------------- /include/g2o/edge_plane_identity.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/g2o/edge_plane_identity.hpp -------------------------------------------------------------------------------- /include/g2o/edge_plane_parallel.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/g2o/edge_plane_parallel.hpp -------------------------------------------------------------------------------- /include/g2o/edge_plane_prior.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/g2o/edge_plane_prior.hpp -------------------------------------------------------------------------------- /include/g2o/edge_se3_gt_utm.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/g2o/edge_se3_gt_utm.hpp -------------------------------------------------------------------------------- /include/g2o/edge_se3_plane.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/g2o/edge_se3_plane.hpp -------------------------------------------------------------------------------- /include/g2o/edge_se3_priorquat.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/g2o/edge_se3_priorquat.hpp -------------------------------------------------------------------------------- /include/g2o/edge_se3_priorvec.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/g2o/edge_se3_priorvec.hpp -------------------------------------------------------------------------------- /include/g2o/edge_se3_priorxy.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/g2o/edge_se3_priorxy.hpp -------------------------------------------------------------------------------- /include/g2o/edge_se3_priorxyz.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/g2o/edge_se3_priorxyz.hpp -------------------------------------------------------------------------------- /include/g2o/edge_se3_priorz.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/g2o/edge_se3_priorz.hpp -------------------------------------------------------------------------------- /include/g2o/edge_se3_se3.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/g2o/edge_se3_se3.hpp -------------------------------------------------------------------------------- /include/g2o/edge_se3_z.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/g2o/edge_se3_z.hpp -------------------------------------------------------------------------------- /include/g2o/robust_kernel_io.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/g2o/robust_kernel_io.hpp -------------------------------------------------------------------------------- /include/radar_ego_velocity_estimator.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/radar_ego_velocity_estimator.h -------------------------------------------------------------------------------- /include/radar_graph_slam/graph_slam.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/radar_graph_slam/graph_slam.hpp -------------------------------------------------------------------------------- /include/radar_graph_slam/information_matrix_calculator.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/radar_graph_slam/information_matrix_calculator.hpp -------------------------------------------------------------------------------- /include/radar_graph_slam/keyframe.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/radar_graph_slam/keyframe.hpp -------------------------------------------------------------------------------- /include/radar_graph_slam/keyframe_updater.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/radar_graph_slam/keyframe_updater.hpp -------------------------------------------------------------------------------- /include/radar_graph_slam/loop_detector.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/radar_graph_slam/loop_detector.hpp -------------------------------------------------------------------------------- /include/radar_graph_slam/map_cloud_generator.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/radar_graph_slam/map_cloud_generator.hpp -------------------------------------------------------------------------------- /include/radar_graph_slam/nmea_sentence_parser.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/radar_graph_slam/nmea_sentence_parser.hpp -------------------------------------------------------------------------------- /include/radar_graph_slam/polynomial_interpolation.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/radar_graph_slam/polynomial_interpolation.hpp -------------------------------------------------------------------------------- /include/radar_graph_slam/registrations.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/radar_graph_slam/registrations.hpp -------------------------------------------------------------------------------- /include/radar_graph_slam/ros_time_hash.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/radar_graph_slam/ros_time_hash.hpp -------------------------------------------------------------------------------- /include/radar_graph_slam/ros_utils.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/radar_graph_slam/ros_utils.hpp -------------------------------------------------------------------------------- /include/rio_utils/data_types.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/rio_utils/data_types.h -------------------------------------------------------------------------------- /include/rio_utils/math_helper.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/rio_utils/math_helper.h -------------------------------------------------------------------------------- /include/rio_utils/radar_point_cloud.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/rio_utils/radar_point_cloud.h -------------------------------------------------------------------------------- /include/rio_utils/ros_helper.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/rio_utils/ros_helper.h -------------------------------------------------------------------------------- /include/rio_utils/simple_profiler.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/rio_utils/simple_profiler.h -------------------------------------------------------------------------------- /include/rio_utils/strapdown.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/rio_utils/strapdown.h -------------------------------------------------------------------------------- /include/scan_context/KDTreeVectorOfVectorsAdaptor.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/scan_context/KDTreeVectorOfVectorsAdaptor.h -------------------------------------------------------------------------------- /include/scan_context/Scancontext.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/scan_context/Scancontext.h -------------------------------------------------------------------------------- /include/scan_context/nanoflann.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/scan_context/nanoflann.hpp -------------------------------------------------------------------------------- /include/scan_context/tictoc.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/scan_context/tictoc.h -------------------------------------------------------------------------------- /include/utility_radar.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/include/utility_radar.h -------------------------------------------------------------------------------- /launch/radar_graph_slam.launch: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/launch/radar_graph_slam.launch -------------------------------------------------------------------------------- /launch/rosbag_play_radar_carpark1.launch: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/launch/rosbag_play_radar_carpark1.launch -------------------------------------------------------------------------------- /launch/rosbag_play_radar_carpark3.launch: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/launch/rosbag_play_radar_carpark3.launch -------------------------------------------------------------------------------- /launch/rosbag_play_radar_garden.launch: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/launch/rosbag_play_radar_garden.launch -------------------------------------------------------------------------------- /launch/rosbag_play_radar_nanyanglink.launch: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/launch/rosbag_play_radar_nanyanglink.launch -------------------------------------------------------------------------------- /launch/rosbag_play_radar_ntuloop1.launch: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/launch/rosbag_play_radar_ntuloop1.launch -------------------------------------------------------------------------------- /launch/rosbag_play_radar_ntuloop2.launch: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/launch/rosbag_play_radar_ntuloop2.launch -------------------------------------------------------------------------------- /launch/rosbag_play_radar_ntuloop3.launch: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/launch/rosbag_play_radar_ntuloop3.launch -------------------------------------------------------------------------------- /launch/rosbag_play_radar_smoke.launch: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/launch/rosbag_play_radar_smoke.launch -------------------------------------------------------------------------------- /msg/FloorCoeffs.msg: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/msg/FloorCoeffs.msg -------------------------------------------------------------------------------- /msg/ScanMatchingStatus.msg: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/msg/ScanMatchingStatus.msg -------------------------------------------------------------------------------- /nodelet_plugins.xml: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/nodelet_plugins.xml -------------------------------------------------------------------------------- /package.xml: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/package.xml -------------------------------------------------------------------------------- /rviz/radar_graph_slam.rviz: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/rviz/radar_graph_slam.rviz -------------------------------------------------------------------------------- /setup.py: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/setup.py -------------------------------------------------------------------------------- /src/g2o/robust_kernel_io.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/src/g2o/robust_kernel_io.cpp -------------------------------------------------------------------------------- /src/gps_traj_align.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/src/gps_traj_align.cpp -------------------------------------------------------------------------------- /src/gt_adjust.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/src/gt_adjust.cpp -------------------------------------------------------------------------------- /src/radar_ego_velocity_estimator.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/src/radar_ego_velocity_estimator.cpp -------------------------------------------------------------------------------- /src/radar_graph_slam/Scancontext.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/src/radar_graph_slam/Scancontext.cpp -------------------------------------------------------------------------------- /src/radar_graph_slam/__init__.py: -------------------------------------------------------------------------------- 1 | -------------------------------------------------------------------------------- /src/radar_graph_slam/bag_player.py: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/src/radar_graph_slam/bag_player.py -------------------------------------------------------------------------------- /src/radar_graph_slam/ford2bag.py: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/src/radar_graph_slam/ford2bag.py -------------------------------------------------------------------------------- /src/radar_graph_slam/graph_slam.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/src/radar_graph_slam/graph_slam.cpp -------------------------------------------------------------------------------- /src/radar_graph_slam/information_matrix_calculator.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/src/radar_graph_slam/information_matrix_calculator.cpp -------------------------------------------------------------------------------- /src/radar_graph_slam/keyframe.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/src/radar_graph_slam/keyframe.cpp -------------------------------------------------------------------------------- /src/radar_graph_slam/loop_detector.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/src/radar_graph_slam/loop_detector.cpp -------------------------------------------------------------------------------- /src/radar_graph_slam/map2odom_publisher.py: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/src/radar_graph_slam/map2odom_publisher.py -------------------------------------------------------------------------------- /src/radar_graph_slam/map_cloud_generator.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/src/radar_graph_slam/map_cloud_generator.cpp -------------------------------------------------------------------------------- /src/radar_graph_slam/registrations.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/src/radar_graph_slam/registrations.cpp -------------------------------------------------------------------------------- /srv/DumpGraph.srv: -------------------------------------------------------------------------------- 1 | 2 | string destination 3 | --- 4 | bool success 5 | -------------------------------------------------------------------------------- /srv/SaveMap.srv: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/zhuge2333/4DRadarSLAM/HEAD/srv/SaveMap.srv --------------------------------------------------------------------------------