getCurrentPose take too long time
I called moveit’s move_group::getCurrentPose() to get the position of the endeffector of a universal robot, but I found it takes more than 1 secs, Real-time performance can not meet the requirements. Is there any solution to improve the real-time of the API, or I just do the forward kinematics through tf will be okay. Here is part of my code
ros::Time getpose_begin_time = ros::Time::now();
static const std::string PLANNING_GROUP = "manipulator";
moveit::planning_interface::MoveGroupInterface move_group(PLANNING_GROUP);
current_pose = move_group.getCurrentPose().pose;
double getpos_time = (ros::Time::now() - getpose_begin_time).toSec();
ROS_INFO ("%f secs for getting pose.", getpos_time);
Here is the ourput ROS_INFO