#include <moveit/planning_pipeline/planning_pipeline.h>#include <moveit/robot_state/conversions.h>#include <moveit/collision_detection/collision_tools.h>#include <moveit/trajectory_processing/trajectory_tools.h>#include <moveit_msgs/DisplayTrajectory.h>#include <visualization_msgs/MarkerArray.h>#include <boost/tokenizer.hpp>#include <boost/algorithm/string/join.hpp>#include <sstream>