├── .gitignore ├── LICENSE ├── README.md ├── cf_msgs ├── CMakeLists.txt ├── msg │ ├── Accel.msg │ ├── Baro.msg │ ├── Flow.msg │ ├── Gyro.msg │ ├── Tdoa.msg │ ├── Tof.msg │ └── Twr.msg └── package.xml ├── dataset ├── ISAS-Walk1.bag ├── ISAS-Walk2.bag └── ISAS-Walk3.bag ├── doc └── util_sequences.gif ├── isas_msgs ├── CMakeLists.txt ├── msg │ ├── AnchorPosition.msg │ ├── Anchorlist.msg │ ├── RTLSRange.msg │ └── RTLSStick.msg └── package.xml ├── sfuise ├── CMakeLists.txt ├── cmake_modules │ └── FindSuiteSparse.cmake ├── config │ ├── config_test_isas-walk1.yaml │ ├── config_test_isas-walk2.yaml │ ├── config_test_isas-walk3.yaml │ ├── config_test_util.yaml │ └── test.rviz ├── include │ ├── Accumulator.h │ ├── Linearizer.h │ ├── Residuals.h │ ├── SplineState.h │ └── utils │ │ ├── PoseVisualization.h │ │ ├── common_utils.h │ │ ├── math_tools.h │ │ └── tic_toc.h ├── launch │ ├── sfuise_test_isas-walk1.launch │ ├── sfuise_test_isas-walk2.launch │ ├── sfuise_test_isas-walk3.launch │ └── sfuise_test_util.launch ├── package.xml └── src │ ├── EstimationInterface.cpp │ └── SplineFusion.cpp └── sfuise_msgs ├── CMakeLists.txt ├── msg ├── Calib.msg ├── Estimate.msg ├── Knot.msg ├── Offset.msg └── Spline.msg └── package.xml /.gitignore: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/.gitignore -------------------------------------------------------------------------------- /LICENSE: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/LICENSE -------------------------------------------------------------------------------- /README.md: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/README.md -------------------------------------------------------------------------------- /cf_msgs/CMakeLists.txt: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/cf_msgs/CMakeLists.txt -------------------------------------------------------------------------------- /cf_msgs/msg/Accel.msg: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/cf_msgs/msg/Accel.msg -------------------------------------------------------------------------------- /cf_msgs/msg/Baro.msg: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/cf_msgs/msg/Baro.msg -------------------------------------------------------------------------------- /cf_msgs/msg/Flow.msg: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/cf_msgs/msg/Flow.msg -------------------------------------------------------------------------------- /cf_msgs/msg/Gyro.msg: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/cf_msgs/msg/Gyro.msg -------------------------------------------------------------------------------- /cf_msgs/msg/Tdoa.msg: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/cf_msgs/msg/Tdoa.msg -------------------------------------------------------------------------------- /cf_msgs/msg/Tof.msg: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/cf_msgs/msg/Tof.msg -------------------------------------------------------------------------------- /cf_msgs/msg/Twr.msg: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/cf_msgs/msg/Twr.msg -------------------------------------------------------------------------------- /cf_msgs/package.xml: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/cf_msgs/package.xml -------------------------------------------------------------------------------- /dataset/ISAS-Walk1.bag: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/dataset/ISAS-Walk1.bag -------------------------------------------------------------------------------- /dataset/ISAS-Walk2.bag: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/dataset/ISAS-Walk2.bag -------------------------------------------------------------------------------- /dataset/ISAS-Walk3.bag: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/dataset/ISAS-Walk3.bag -------------------------------------------------------------------------------- /doc/util_sequences.gif: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/doc/util_sequences.gif -------------------------------------------------------------------------------- /isas_msgs/CMakeLists.txt: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/isas_msgs/CMakeLists.txt -------------------------------------------------------------------------------- /isas_msgs/msg/AnchorPosition.msg: -------------------------------------------------------------------------------- 1 | uint16 id 2 | geometry_msgs/Point position 3 | -------------------------------------------------------------------------------- /isas_msgs/msg/Anchorlist.msg: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/isas_msgs/msg/Anchorlist.msg -------------------------------------------------------------------------------- /isas_msgs/msg/RTLSRange.msg: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/isas_msgs/msg/RTLSRange.msg -------------------------------------------------------------------------------- /isas_msgs/msg/RTLSStick.msg: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/isas_msgs/msg/RTLSStick.msg -------------------------------------------------------------------------------- /isas_msgs/package.xml: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/isas_msgs/package.xml -------------------------------------------------------------------------------- /sfuise/CMakeLists.txt: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/sfuise/CMakeLists.txt -------------------------------------------------------------------------------- /sfuise/cmake_modules/FindSuiteSparse.cmake: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/sfuise/cmake_modules/FindSuiteSparse.cmake -------------------------------------------------------------------------------- /sfuise/config/config_test_isas-walk1.yaml: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/sfuise/config/config_test_isas-walk1.yaml -------------------------------------------------------------------------------- /sfuise/config/config_test_isas-walk2.yaml: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/sfuise/config/config_test_isas-walk2.yaml -------------------------------------------------------------------------------- /sfuise/config/config_test_isas-walk3.yaml: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/sfuise/config/config_test_isas-walk3.yaml -------------------------------------------------------------------------------- /sfuise/config/config_test_util.yaml: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/sfuise/config/config_test_util.yaml -------------------------------------------------------------------------------- /sfuise/config/test.rviz: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/sfuise/config/test.rviz -------------------------------------------------------------------------------- /sfuise/include/Accumulator.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/sfuise/include/Accumulator.h -------------------------------------------------------------------------------- /sfuise/include/Linearizer.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/sfuise/include/Linearizer.h -------------------------------------------------------------------------------- /sfuise/include/Residuals.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/sfuise/include/Residuals.h -------------------------------------------------------------------------------- /sfuise/include/SplineState.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/sfuise/include/SplineState.h -------------------------------------------------------------------------------- /sfuise/include/utils/PoseVisualization.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/sfuise/include/utils/PoseVisualization.h -------------------------------------------------------------------------------- /sfuise/include/utils/common_utils.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/sfuise/include/utils/common_utils.h -------------------------------------------------------------------------------- /sfuise/include/utils/math_tools.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/sfuise/include/utils/math_tools.h -------------------------------------------------------------------------------- /sfuise/include/utils/tic_toc.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/sfuise/include/utils/tic_toc.h -------------------------------------------------------------------------------- /sfuise/launch/sfuise_test_isas-walk1.launch: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/sfuise/launch/sfuise_test_isas-walk1.launch -------------------------------------------------------------------------------- /sfuise/launch/sfuise_test_isas-walk2.launch: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/sfuise/launch/sfuise_test_isas-walk2.launch -------------------------------------------------------------------------------- /sfuise/launch/sfuise_test_isas-walk3.launch: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/sfuise/launch/sfuise_test_isas-walk3.launch -------------------------------------------------------------------------------- /sfuise/launch/sfuise_test_util.launch: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/sfuise/launch/sfuise_test_util.launch -------------------------------------------------------------------------------- /sfuise/package.xml: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/sfuise/package.xml -------------------------------------------------------------------------------- /sfuise/src/EstimationInterface.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/sfuise/src/EstimationInterface.cpp -------------------------------------------------------------------------------- /sfuise/src/SplineFusion.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/sfuise/src/SplineFusion.cpp -------------------------------------------------------------------------------- /sfuise_msgs/CMakeLists.txt: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/sfuise_msgs/CMakeLists.txt -------------------------------------------------------------------------------- /sfuise_msgs/msg/Calib.msg: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/sfuise_msgs/msg/Calib.msg -------------------------------------------------------------------------------- /sfuise_msgs/msg/Estimate.msg: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/sfuise_msgs/msg/Estimate.msg -------------------------------------------------------------------------------- /sfuise_msgs/msg/Knot.msg: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/sfuise_msgs/msg/Knot.msg -------------------------------------------------------------------------------- /sfuise_msgs/msg/Offset.msg: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/sfuise_msgs/msg/Offset.msg -------------------------------------------------------------------------------- /sfuise_msgs/msg/Spline.msg: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/sfuise_msgs/msg/Spline.msg -------------------------------------------------------------------------------- /sfuise_msgs/package.xml: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/ASIG-X/SFUISE/HEAD/sfuise_msgs/package.xml --------------------------------------------------------------------------------