├── .editorconfig ├── .gitignore ├── .travis.yml ├── CHANGELOG.rst ├── CMakeLists.txt ├── LICENSE ├── README.md ├── cfg ├── TebLocalPlannerReconfigure.cfg └── rviz_test_optim.rviz ├── cmake_modules ├── FindG2O.cmake └── FindSUITESPARSE.cmake ├── include └── teb_local_planner │ ├── distance_calculations.h │ ├── g2o_types │ ├── edge_acceleration.h │ ├── edge_dynamic_obstacle.h │ ├── edge_human_human_safety.h │ ├── edge_human_robot_directional.h │ ├── edge_human_robot_safety.h │ ├── edge_human_robot_ttc.h │ ├── edge_kinematics.h │ ├── edge_obstacle.h │ ├── edge_time_optimal.h │ ├── edge_velocity.h │ ├── edge_via_point.h │ ├── penalties.h │ ├── vertex_pose.h │ └── vertex_timediff.h │ ├── homotopy_class_planner.h │ ├── homotopy_class_planner.hpp │ ├── misc.h │ ├── obstacles.h │ ├── optimal_planner.h │ ├── planner_interface.h │ ├── pose_se2.h │ ├── robot_footprint_model.h │ ├── teb_config.h │ ├── teb_local_planner_ros.h │ ├── timed_elastic_band.h │ ├── timed_elastic_band.hpp │ ├── visualization.h │ └── visualization.hpp ├── launch └── test_optim_node.launch ├── msg ├── FeedbackMsg.msg ├── ObstacleMsg.msg ├── OptimizationCost.msg ├── OptimizationCostArray.msg ├── TrajectoryMsg.msg └── TrajectoryPointMsg.msg ├── package.xml ├── scripts ├── cmd_vel_to_ackermann_drive.py ├── export_to_mat.py ├── export_to_svg.py ├── publish_test_obstacles.py └── visualize_velocity_profile.py ├── src ├── homotopy_class_planner.cpp ├── obstacles.cpp ├── optimal_planner.cpp ├── teb_config.cpp ├── teb_local_planner_ros.cpp ├── test_optim_node.cpp ├── timed_elastic_band.cpp └── visualization.cpp ├── srv ├── Approach.srv └── Optimize.srv └── teb_local_planner_plugin.xml /.editorconfig: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/.editorconfig -------------------------------------------------------------------------------- /.gitignore: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/.gitignore -------------------------------------------------------------------------------- /.travis.yml: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/.travis.yml -------------------------------------------------------------------------------- /CHANGELOG.rst: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/CHANGELOG.rst -------------------------------------------------------------------------------- /CMakeLists.txt: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/CMakeLists.txt -------------------------------------------------------------------------------- /LICENSE: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/LICENSE -------------------------------------------------------------------------------- /README.md: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/README.md -------------------------------------------------------------------------------- /cfg/TebLocalPlannerReconfigure.cfg: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/cfg/TebLocalPlannerReconfigure.cfg -------------------------------------------------------------------------------- /cfg/rviz_test_optim.rviz: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/cfg/rviz_test_optim.rviz -------------------------------------------------------------------------------- /cmake_modules/FindG2O.cmake: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/cmake_modules/FindG2O.cmake -------------------------------------------------------------------------------- /cmake_modules/FindSUITESPARSE.cmake: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/cmake_modules/FindSUITESPARSE.cmake -------------------------------------------------------------------------------- /include/teb_local_planner/distance_calculations.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/include/teb_local_planner/distance_calculations.h -------------------------------------------------------------------------------- /include/teb_local_planner/g2o_types/edge_acceleration.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/include/teb_local_planner/g2o_types/edge_acceleration.h -------------------------------------------------------------------------------- /include/teb_local_planner/g2o_types/edge_dynamic_obstacle.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/include/teb_local_planner/g2o_types/edge_dynamic_obstacle.h -------------------------------------------------------------------------------- /include/teb_local_planner/g2o_types/edge_human_human_safety.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/include/teb_local_planner/g2o_types/edge_human_human_safety.h -------------------------------------------------------------------------------- /include/teb_local_planner/g2o_types/edge_human_robot_directional.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/include/teb_local_planner/g2o_types/edge_human_robot_directional.h -------------------------------------------------------------------------------- /include/teb_local_planner/g2o_types/edge_human_robot_safety.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/include/teb_local_planner/g2o_types/edge_human_robot_safety.h -------------------------------------------------------------------------------- /include/teb_local_planner/g2o_types/edge_human_robot_ttc.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/include/teb_local_planner/g2o_types/edge_human_robot_ttc.h -------------------------------------------------------------------------------- /include/teb_local_planner/g2o_types/edge_kinematics.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/include/teb_local_planner/g2o_types/edge_kinematics.h -------------------------------------------------------------------------------- /include/teb_local_planner/g2o_types/edge_obstacle.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/include/teb_local_planner/g2o_types/edge_obstacle.h -------------------------------------------------------------------------------- /include/teb_local_planner/g2o_types/edge_time_optimal.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/include/teb_local_planner/g2o_types/edge_time_optimal.h -------------------------------------------------------------------------------- /include/teb_local_planner/g2o_types/edge_velocity.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/include/teb_local_planner/g2o_types/edge_velocity.h -------------------------------------------------------------------------------- /include/teb_local_planner/g2o_types/edge_via_point.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/include/teb_local_planner/g2o_types/edge_via_point.h -------------------------------------------------------------------------------- /include/teb_local_planner/g2o_types/penalties.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/include/teb_local_planner/g2o_types/penalties.h -------------------------------------------------------------------------------- /include/teb_local_planner/g2o_types/vertex_pose.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/include/teb_local_planner/g2o_types/vertex_pose.h -------------------------------------------------------------------------------- /include/teb_local_planner/g2o_types/vertex_timediff.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/include/teb_local_planner/g2o_types/vertex_timediff.h -------------------------------------------------------------------------------- /include/teb_local_planner/homotopy_class_planner.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/include/teb_local_planner/homotopy_class_planner.h -------------------------------------------------------------------------------- /include/teb_local_planner/homotopy_class_planner.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/include/teb_local_planner/homotopy_class_planner.hpp -------------------------------------------------------------------------------- /include/teb_local_planner/misc.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/include/teb_local_planner/misc.h -------------------------------------------------------------------------------- /include/teb_local_planner/obstacles.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/include/teb_local_planner/obstacles.h -------------------------------------------------------------------------------- /include/teb_local_planner/optimal_planner.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/include/teb_local_planner/optimal_planner.h -------------------------------------------------------------------------------- /include/teb_local_planner/planner_interface.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/include/teb_local_planner/planner_interface.h -------------------------------------------------------------------------------- /include/teb_local_planner/pose_se2.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/include/teb_local_planner/pose_se2.h -------------------------------------------------------------------------------- /include/teb_local_planner/robot_footprint_model.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/include/teb_local_planner/robot_footprint_model.h -------------------------------------------------------------------------------- /include/teb_local_planner/teb_config.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/include/teb_local_planner/teb_config.h -------------------------------------------------------------------------------- /include/teb_local_planner/teb_local_planner_ros.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/include/teb_local_planner/teb_local_planner_ros.h -------------------------------------------------------------------------------- /include/teb_local_planner/timed_elastic_band.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/include/teb_local_planner/timed_elastic_band.h -------------------------------------------------------------------------------- /include/teb_local_planner/timed_elastic_band.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/include/teb_local_planner/timed_elastic_band.hpp -------------------------------------------------------------------------------- /include/teb_local_planner/visualization.h: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/include/teb_local_planner/visualization.h -------------------------------------------------------------------------------- /include/teb_local_planner/visualization.hpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/include/teb_local_planner/visualization.hpp -------------------------------------------------------------------------------- /launch/test_optim_node.launch: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/launch/test_optim_node.launch -------------------------------------------------------------------------------- /msg/FeedbackMsg.msg: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/msg/FeedbackMsg.msg -------------------------------------------------------------------------------- /msg/ObstacleMsg.msg: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/msg/ObstacleMsg.msg -------------------------------------------------------------------------------- /msg/OptimizationCost.msg: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/msg/OptimizationCost.msg -------------------------------------------------------------------------------- /msg/OptimizationCostArray.msg: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/msg/OptimizationCostArray.msg -------------------------------------------------------------------------------- /msg/TrajectoryMsg.msg: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/msg/TrajectoryMsg.msg -------------------------------------------------------------------------------- /msg/TrajectoryPointMsg.msg: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/msg/TrajectoryPointMsg.msg -------------------------------------------------------------------------------- /package.xml: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/package.xml -------------------------------------------------------------------------------- /scripts/cmd_vel_to_ackermann_drive.py: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/scripts/cmd_vel_to_ackermann_drive.py -------------------------------------------------------------------------------- /scripts/export_to_mat.py: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/scripts/export_to_mat.py -------------------------------------------------------------------------------- /scripts/export_to_svg.py: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/scripts/export_to_svg.py -------------------------------------------------------------------------------- /scripts/publish_test_obstacles.py: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/scripts/publish_test_obstacles.py -------------------------------------------------------------------------------- /scripts/visualize_velocity_profile.py: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/scripts/visualize_velocity_profile.py -------------------------------------------------------------------------------- /src/homotopy_class_planner.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/src/homotopy_class_planner.cpp -------------------------------------------------------------------------------- /src/obstacles.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/src/obstacles.cpp -------------------------------------------------------------------------------- /src/optimal_planner.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/src/optimal_planner.cpp -------------------------------------------------------------------------------- /src/teb_config.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/src/teb_config.cpp -------------------------------------------------------------------------------- /src/teb_local_planner_ros.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/src/teb_local_planner_ros.cpp -------------------------------------------------------------------------------- /src/test_optim_node.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/src/test_optim_node.cpp -------------------------------------------------------------------------------- /src/timed_elastic_band.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/src/timed_elastic_band.cpp -------------------------------------------------------------------------------- /src/visualization.cpp: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/src/visualization.cpp -------------------------------------------------------------------------------- /srv/Approach.srv: -------------------------------------------------------------------------------- 1 | # Start approach behavior 2 | 3 | uint64 human_id 4 | --- 5 | bool success 6 | string message 7 | -------------------------------------------------------------------------------- /srv/Optimize.srv: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/srv/Optimize.srv -------------------------------------------------------------------------------- /teb_local_planner_plugin.xml: -------------------------------------------------------------------------------- https://raw.githubusercontent.com/harmishhk/hateb_local_planner/HEAD/teb_local_planner_plugin.xml --------------------------------------------------------------------------------