robossembler/runtime
7
0
Fork 0
Code Issues 5 Pull requests Projects Releases Packages Wiki Activity Actions

Merge remote-tracking branch 'origin/89-debug_megapose_in_ROS2' into 90-real-robot-setup

Browse source
This commit is contained in:
Ilya Uraev 2023-12-17 22:27:03 +03:00
commit ec0aba0b2e
9 changed files with 94132 additions and 220614 deletions
Download patch file Download diff file Expand all files Collapse all files

17
rbs_bt_executor/src/PoseEstimation.cpp
View file

@ -23,12 +23,10 @@ public:
while (!_set_params_client->wait_for_service(1s)) {
if (!rclcpp::ok()) {
RCLCPP_ERROR(_node->get_logger(),
"Interrupted while waiting for the service. Exiting.");
RCLCPP_ERROR(_node->get_logger(), "Interrupted while waiting for the service. Exiting.");
break;
}
RCLCPP_WARN(_node->get_logger(),
"service not available, waiting again...");
RCLCPP_WARN(_node->get_logger(), "service not available, waiting again...");
}
_model_name = getInput<std::string>("ObjectName").value();
@ -72,6 +70,9 @@ private:
if (req_type == "configure") {
set_mesh_param();
transition_id_ = lifecycle_msgs::msg::Transition::TRANSITION_CONFIGURE;
} else if (req_type == "calibrate") {
set_str_param();
transition_id_ = lifecycle_msgs::msg::Transition::TRANSITION_CONFIGURE;
} else if (req_type == "activate") {
transition_id_ = lifecycle_msgs::msg::Transition::TRANSITION_ACTIVATE;
} else if (req_type == "deactivate") {
@ -79,6 +80,7 @@ private:
} else if (req_type == "cleanup") {
transition_id_ = lifecycle_msgs::msg::Transition::TRANSITION_CLEANUP;
}
//calibrate
translation.set__id(transition_id_);
return translation;
}
@ -92,6 +94,13 @@ private:
return model_path;
}
void set_str_param() {
RCLCPP_INFO_STREAM(_node->get_logger(), "Set string parameter: <" + _model_name + ">");
std::vector<rclcpp::Parameter> _parameters{rclcpp::Parameter("mesh_path", _model_name)};
_set_params_client->set_parameters(_parameters);
}
void set_mesh_param() {
auto _package_name =
ament_index_cpp::get_package_share_directory("rbs_perception");