#include <ros/ros.h>
#include <ros/console.h>
#include <choreo_output_processor/choreo_output_processor.h>
#include <choreo_rapidjson/include/rapidjson/document.h>
#include <choreo_rapidjson/include/rapidjson/filewritestream.h>
#include <choreo_rapidjson/include/rapidjson/prettywriter.h>
#include <trajectory_msgs/JointTrajectoryPoint.h>
#include <tf_conversions/tf_eigen.h>
#include <eigen_conversions/eigen_msg.h>