Add rmw zenoh cpp to ci

[mini-1235]

---

Basic Info

Info	Please fill out this column
Ticket(s) this addresses	closes #5509
Primary OS tested on	Ubuntu
Robotic platform tested on
Does this PR contain AI generated software?	No
Was this PR description generated by AI software?	Out of respect for maintainers, AI for human-to-human communications are banned

---

Description of contribution in a few bullet points

• Add zenoh to ci matrix
• Fix tests to pass with zenoh

Description of documentation updates required from your changes

Description of how this change was tested

---

Future work that may be required in bullet points

For Maintainers:

• Check that any new parameters added are updated in docs.nav2.org
• Check that any significant change is added to the migration guide
• Check that any new features OR changes to existing behaviors are reflected in the tuning guide
• Check that any new functions have Doxygen added
• Check that any new features have test coverage
• Check that any new plugins is added to the plugins page
• If BT Node, Additionally: add to BT's XML index of nodes for groot, BT package's readme table, and BT library lists
• Should this be backported to current distributions? If so, tag with backport-*.

[mini-1235]

Two of the tests are still failing, this PR is not ready for review

[SteveMacenski]

Please leave the default as is before merging, but I understand it’s useful to test in CI for now.

Also, why did the docking test need to be updated? Did you find root cause or is that a workaround for zenoh to work? If a workaround, that might indicate a problem in the RMW if there’s not a logical error in the test.

[mini-1235]

Please leave the default as is before merging, but I understand it’s useful to test in CI for now.

Will do after all tests pass

Also, why did the docking test need to be updated? Did you find root cause or is that a workaround for zenoh to work? If a workaround, that might indicate a problem in the RMW if there’s not a logical error in the test.

I will explain the changes I made to the test here:

• test_distance_controller: originally reporting Input t_sec is too large or too small for tf2::Duration, the cause is due to missing declare_parameter for transform tolerance

• test_astar: thread panicked, related to https://github.com/ros2/rmw_zenoh?tab=readme-ov-file#crash-when-program-terminates

• test_controller: flaky, it fails when the subscriber does not receive the latest costmap message published here

navigation2/nav2_docking/opennav_docking/test/test_controller.cpp

Line 514 in 8aea1a8

collision_tester->publishCostmap();

I can actually reproduce this as well in cyclonedds when running 1000 times repeatedly

• test_bt_navigator_with_wrong_init_pose (still failing): this is because the initial_transform_timeout and rmw zenoh's queries_default_timeout are both 60s by default. If we set the timeout to > 60s in service client, and it actually takes > 60s for the service server, then it will fail, see more in Service call reports z_reply_is_ok returned False Reason: Timeout ros2/rmw_zenoh#783

We can actually decrease initial_transform_timeout / increase queries_default_timeout and overwrite the default zenoh config, but I am not sure if these are the best solutions

[SteveMacenski]

Ok sounds good to me. I might prefer spinning for those 10ms rather than having a background spin & 10ms sleeps, but I generally don’t nitpick over tests. Are you working on the last failure in CI? The rest LGTM

[mini-1235]

Are you working on the last failure in CI?

Yes, it looks like that we need to overwrite the zenoh config at least for the CI ros2/rmw_zenoh#783 (comment), what do you think about that?

[SteveMacenski]

It seems to me like something that should be addressed in the RMW / Zenoh layers. If this is a quirk of ROS 2, then either that should change, RMW Zenoh should adjust, or the default configurations should handle it.

[mini-1235]

It seems to me like something that should be addressed in the RMW / Zenoh layers. If this is a quirk of ROS 2, then either that should change, RMW Zenoh should adjust, or the default configurations should handle it.

I share the same opinion. Admittedly, I am not a zenoh expert, so I think I might need to leave this PR open until we can find a solution together with the zenoh maintainers

[SteveMacenski]

OK - did you open a ticket on this with the RMW? Might be good and then link this PR

[mini-1235]

OK - did you open a ticket on this with the RMW? Might be good and then link this PR

Good idea, I have open a new issue in the rmw repo

[mergify]

This pull request is in conflict. Could you fix it @mini-1235?

[mini-1235]

@SteveMacenski, I have just rebased this, now waiting for next rmw zenoh's release to pass all tests

[SteveMacenski]

OK! Ping me when we can take a look again!