| 35 | // locations |
| 36 | template <typename T> |
| 37 | bool condParam(ros::NodeHandle *nh, |
| 38 | const std::string ¶m_name, |
| 39 | T ¶m_val, |
| 40 | const T &default_val, |
| 41 | const std::string &prefix = "/patchwork") { |
| 42 | if (nh->hasParam(prefix + "/" + param_name)) { |
| 43 | if (nh->getParam(prefix + "/" + param_name, param_val)) { |
| 44 | ROS_INFO_STREAM("param '" << prefix << "/" << param_name << "' -> '" << param_val << "'"); |
| 45 | return true; |
| 46 | } |
| 47 | } else if (nh->hasParam(ros::this_node::getName() + "/" + param_name)) { |
| 48 | if (nh->getParam(ros::this_node::getName() + "/" + param_name, param_val)) { |
| 49 | ROS_INFO_STREAM("param '" << ros::this_node::getName() << "/" << param_name << "' -> '" |
| 50 | << param_val << "'"); |
| 51 | return true; |
| 52 | } |
| 53 | } |
| 54 | param_val = default_val; |
| 55 | ROS_INFO_STREAM("param '" << param_name << "' -> '" << param_val << "' (default)"); |
| 56 | return false; |
| 57 | } |
| 58 | |
| 59 | #define NUM_HEURISTIC_MAX_PTS_IN_PATCH 3000 |
| 60 | #define MARKER_Z_VALUE -2.2 |