"getElem() should not see invalid handles" in kinetic

[Jeffrey53]

My program exits cause I call sendGoal and print"getElem() should not see invalid handles"

[Jeffrey53]

occasionally appear.
Here is my code:

bool RosInterface::callNavModeAction(const NavModeParameter &parameter) {
if (nav_mode_action_ == nullptr) nav_mode_action_ = std::make_shared(*n_, "navigation_mode");

if (!nav_mode_action_.get()->waitForServer(ros::Duration(3))) {
if (ros_msg_callback_ != nullptr) ros_msg_callback_("action server is invalid,action:navigation_mode");
return false;
}

aic_msgs::NavigationModeGoal goal;
goal.id = parameter.id;
goal.navigation_mode = static_cast<uint8_t>(parameter.mode);
goal.waiting_timeout = parameter.wait_time;
goal.max_speed = parameter.max_speed;
goal.permitted_passage = parameter.permitted_passage;
goal.capacity = parameter.capacity;
nav_mode_action_.get()->sendGoal(goal, boost::bind(&RosInterface::navModeCB, this, _1, _2));

if (ros_msg_callback_ != nullptr) ros_msg_callback_("send goal,action:navigation_mode");
return true;
}

void RosInterface::navModeCB(const actionlib::SimpleClientGoalState& state,
const aic_msgs::NavigationModeResultConstPtr&) {
if (ros_msg_callback_ != nullptr)
ros_msg_callback_("navModeCB called,state:" + std::to_string(static_cast<int32_t>(state.state_)));
}