#include <pluginlib/class_list_macros.h>
#include <rigid_body_handler/GetTwistHandler.h>
#include <v_repLib.h>
#include <vrep_ros_plugin/access.h>
#include <geometry_msgs/TwistStamped.h>
#include <Eigen/Geometry>
#include <vrep_ros_plugin/ConsoleHandler.h>