pub a joint angles to baxter_moveit_stomp_trac_ik [closed]

edit

Hi at all,when i roslaunch baxter_moveit_stomp_trac_ik_config demo.launch and pub the joint angles goal to moveit :

using namespace std;
boost::shared_ptr<moveit::planning_interface::MoveGroup> group;
void testPlaceTarget(string namedTarget ,int sleepTime)
{
    ros::AsyncSpinner spinner(1);
    spinner.start();
    group->setMaxVelocityScalingFactor(0.5);
    group->setMaxAccelerationScalingFactor(0.5);
    group->setNamedTarget(namedTarget);       //group->setPoseTarget(goalPose);
    group->move();
    sleep(sleepTime);
    spinner.stop();
}
void testTargeByJointAngel(int sleepTime)
{
    ros::AsyncSpinner spinner(1);
    spinner.start();
    moveit::planning_interface::MoveGroup::Plan planner;
    bool is_success;
    vector<double> joint_angles(7);
    joint_angles[0]=-0.6699952259595108;
    joint_angles[1]=1.030009435085784;
    joint_angles[2]=0.4999997247485215;
    joint_angles[3]=-0.189968899785275;
    joint_angles[4]=1.9400238130755056;
    joint_angles[5]=0.08000397926829805;
    joint_angles[6]=-0.9999781166910306;
    group->setJointValueTarget(joint_angles);
    is_success=group->plan(planner);
    if(is_success)
    {  group->move(); }
     else
    {  cout<<"Move to place pose: Planning fail!"<<endl; }
    sleep(sleepTime);
    spinner.stop();
}
int main(int argc, char **argv)
{
     ros::init(argc,argv,"test");
     ros::NodeHandle nh;
     group.reset();
     group = boost::make_shared<moveit::planning_interface::MoveGroup>("right_arm");
     group->setPoseReferenceFrame("/base");
     group->setMaxVelocityScalingFactor(0.5);
     group->setMaxAccelerationScalingFactor(0.5);
     testTargeByJointAngel(0.2);
     return 0;
}

then show the error:

[ERROR] [1500364396.767677864]: Found empty JointState message
[ERROR] [1500364396.767731905]: Found empty JointState message
[ERROR] [1500364396.768128614]: Found empty JointState message
[ERROR] [1500364396.789180781]: Found empty JointState message
[ERROR] [1500364396.789299823]: STOMP Failed to extract start state from MotionPlanRequest
[ERROR] [1500364396.789350698]: STOMP failed to get the start and goal

Hope that someone here can help me ,thanks.

LiYI