InitialAction.cpp

#include <sarafun_tree/sarafun_action_nodes/InitialAction.h>

namespace sarafun {
bool InitialAction::fillGoal(sarafun_msgs::InitialKeyframeGoal &goal) {
  int idx;

  fillParameter("/sarafun/initial/idx", 0, idx);
  goal.idx = idx;

  return true;
}

double InitialAction::getTimeoutValue() {
  double timeout = 0;
  fillParameter("/sarafun/bt_action_nodes/initial/timeout", 30.0, timeout);

  return timeout;
}
}

int main(int argc, char **argv) {
  ros::init(argc, argv, "InitialAction");
  std::string bt_client_name, action_server_name;

  if (!ros::param::get("/sarafun/bt_action_nodes/initial/action_server_name", action_server_name))
  {
    ROS_ERROR("%s missing action server name", ros::this_node::getName().c_str());
    return -1;
  }

  if (!ros::param::get("/sarafun/bt_action_nodes/initial/bt_client_name", bt_client_name))
  {
    ROS_ERROR("%s missing bt client name", ros::this_node::getName().c_str());
    return -1;
  }

  sarafun::InitialAction initial_action(
      ros::this_node::getName(),  action_server_name, bt_client_name);
  ros::spin();
  return 1;
}