rviz_visual_tools indigo not defined.. publishpath or publishline
Hey all,
anyone here who worked with the rviz_visual_tools under indigo? How can i visualize a path of my waypoints of my computecartesianpath-function in rviz? the waypoints are defined as geometry_msgs/path and the publishpath-function of rviz_visual_tools only works with geometry_msgs/point. I tried something like:
namespace rvt = rviz_visual_tools;
rviz_visual_tools::RvizVisualTools visual_tools("odom_combined");
std::vector<geometry_msgs::Pose> waypoints;
geometry_msgs::Pose target_pose3;
target_pose3.position.x=0.02;
target_pose3.position.y=0.12;
target_pose3.position.z=0.25;
target_pose3.orientation.x=0.75;
target_pose3.orientation.y=0.48;
target_pose3.orientation.z=-0.31;
target_pose3.orientation.w=0.32;
waypoints.push_back(target_pose3);
target_pose3.position.x=0.27;
target_pose3.position.y=-0.06;
target_pose3.position.z=0.18;
target_pose3.orientation.x=0.315;
target_pose3.orientation.y=0.902;
target_pose3.orientation.z=0.021;
target_pose3.orientation.w=0.29;
waypoints.push_back(target_pose3);
moveit_msgs::RobotTrajectory trajectory;
double fraction = group.computeCartesianPath(waypoints, 0.01, 0.0, trajectory);
ROS_INFO("Visualize CartesianPath (%.2f%% acheived)",fraction*100);
geometry_msgs::Point path[waypoints.size()];
for(int i=0; i<waypoints.size(); i++)
{
path[i] = waypoints[i].position;
std::cout << "Point: " << path[i] << "\n";
}
visual_tools.deleteAllMarkers();
visual_tools.publishLine(path[0], path[1], rvt::RED, rvt::LARGE);
The Errorcode is: "Not defined reference"(translated it from german: Nicht definierter Verweis) for every function of the rviz_visual_tools. Do you have any suggestions?
Thank you!
ali