Skip to content

Zenoh Integration To MoveIt#2879

Closed
CihatAltiparmak wants to merge 7 commits intomoveit:mainfrom
CihatAltiparmak:zenoh
Closed

Zenoh Integration To MoveIt#2879
CihatAltiparmak wants to merge 7 commits intomoveit:mainfrom
CihatAltiparmak:zenoh

Conversation

@CihatAltiparmak
Copy link
Copy Markdown
Member

@CihatAltiparmak CihatAltiparmak commented Jun 24, 2024

Description

I made a few modifications for MoveIt to be able to run with rmw_zenoh middleware implementation. This is experimental PR and should not be merged. It seems this modifications works well with rmw_zenoh. We have actually just changed below (see my reviews) parts. I also added this PR's commits. By the way i don't know how these changes affect MoveIt execution flow. I am still investigating.

Checklist

  • Required by CI: Code is auto formatted using clang-format
  • Extend the tutorials / documentation reference
  • Document API changes relevant to the user in the MIGRATION.md notes
  • Create tests, which fail without this PR reference
  • Include a screenshot if changing a GUI
  • While waiting for someone to review your request, please help review another open pull request to support the maintainers

CihatAltiparmak and others added 7 commits June 7, 2024 21:09
…ods of move_group_interface

- Reimplemented getPlannerParams, setPlannerParams, getInterfaceDescription, getInterfaceDescriptions, plan, execute, move and computeCartesianPath methods of move_group_interface using rclcpp's own api
- Removed callback_thread_
…rmw_wait issues of rmw_zenoh

- Changed move_group server's executor as SingleThreadedExecutor
- Added event_topic_subsciber to different executor
@CihatAltiparmak CihatAltiparmak marked this pull request as draft June 24, 2024 15:12
RCLCPP_INFO(nh->get_logger(), "MoveGroup debug mode is OFF");
}

rclcpp::executors::MultiThreadedExecutor executor;
Copy link
Copy Markdown
Member Author

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

We have modified this part due to the fact that rmw_wait function of rmw_zenoh still has some problems. We must use SingleThreadedExecutor at the moment.

Comment on lines +196 to +202
auto callback_group = node_->create_callback_group(rclcpp::CallbackGroupType::MutuallyExclusive, false);
auto options = rclcpp::SubscriptionOptions();
options.callback_group = callback_group;
event_topic_subscriber_ = node_->create_subscription<std_msgs::msg::String>(
EXECUTION_EVENT_TOPIC, rclcpp::SystemDefaultsQoS(),
[this](const std_msgs::msg::String::ConstSharedPtr& event) { return receiveEvent(event); }, options);
private_executor_->add_callback_group(callback_group, node_->get_node_base_interface());
Copy link
Copy Markdown
Member Author

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

I added this callback group to private_executor that also spins control_manager node so that event_topic_subscriber receives callback to stop trajectory execution. Shortly, it seems MultiThreadedExecutor in MoveIt's default implementation is just for spinning this subscription.

@CihatAltiparmak
Copy link
Copy Markdown
Member Author

CihatAltiparmak commented Aug 21, 2024

It's not necessary anymore. rmw_zenoh is able to run with MultiThreadedExecutor now . Closing.

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment

Labels

None yet

Projects

None yet

Development

Successfully merging this pull request may close these issues.

2 participants