This is the source code of our paper. If you find this code useful in your research, please consider citing our work:
LUGOT: LiDAR SLAM and UWB Fusion for Robust Global Given Object Tracking
- Main Function
Directly run themain.mfunction, which initializes parameters and invokes all other functional programs.
Warnings encountered during runtime do not affect the results and can be safely ignored.
-
Coordinate Transformation
Executeuwb_to_map0.mto transform the coordinate system.
Set theSLAM_FLAGparameter within this script to select results from different SLAM systems. -
Load Hyperparameters
Load thehyper_parameter.matfile to import necessary hyperparameters. -
Filtering
RunLUGOT.slxto perform *KF filtering. -
Smoothing Spline Fitting
Runsmoothing_spline_fit.mto fit the UWB trajectory using a smoothing spline. -
Process Noise Calculation
Runcalc_process_noise.mto calculate process noise. -
Visualization
Executeplot_resault.mto visualize the filtering results. -
Statistical Analysis
Runplot_statistics.mto generate statistical data visualizations, including various RMSE metrics.
- Version: 1.2.0
- Release Date: 2024-11-19
- Notes:
- modify for 3rd review.