Skip to content

Added keepout filter for depot and warehouse maps #5125

New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

Merged

Conversation

leander-dsouza
Copy link
Contributor

@leander-dsouza leander-dsouza commented May 4, 2025


Basic Info

Info Please fill out this column
Ticket(s) this addresses #4400
Primary OS tested on Ubuntu
Robotic platform tested on Turtlebot4 Simulation
Does this PR contain AI generated software? No

Description of testing performed

  • Validated lintiing using pre-commit
  • Tested the package using colcon test.

Description of contribution in a few bullet points

Depot

  • Added a keepout region at the centre of the depot map in turtlebot4.

    tb4_keepout_depot

    keepout_filter_demo_depot.mp4

Warehouse

  • Added a keepout region at the centre of the warehouse map in turtlebot4.

    tb4_keepout

    keepout_filter_demo.mp4
  • Added a keepout_map and use_keepout_filter as launch arguments.

  • Added a constant dictionary for easily switching between depot and warehouse maps for turtlebot4.

Description of documentation updates required from your changes

  • A small tutorial can be added once the speed zones are added to both depot and warehouse worlds.

Description of how this change was tested

  • A goal was given, and the robot avoided the keepout region.

Future work that may be required in bullet points

  • Add speed zones in warehouse and depot maps.

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

@leander-dsouza leander-dsouza marked this pull request as ready for review May 5, 2025 00:13
Copy link

codecov bot commented May 5, 2025

Codecov Report

Attention: Patch coverage is 88.88889% with 1 line in your changes missing coverage. Please review.

Files with missing lines Patch % Lines
nav2_costmap_2d/src/layer.cpp 85.71% 1 Missing ⚠️
Files with missing lines Coverage Δ
...stmap_2d/include/nav2_costmap_2d/costmap_layer.hpp 100.00% <ø> (ø)
nav2_costmap_2d/include/nav2_costmap_2d/layer.hpp 100.00% <ø> (ø)
...tmap_2d/plugins/costmap_filters/keepout_filter.cpp 96.51% <100.00%> (+2.32%) ⬆️
nav2_costmap_2d/src/costmap_layer.cpp 67.82% <ø> (-1.03%) ⬇️
nav2_costmap_2d/src/layer.cpp 89.47% <85.71%> (-0.85%) ⬇️

... and 5 files with indirect coverage changes

🚀 New features to boost your workflow:
  • ❄️ Test Analytics: Detect flaky tests, report on failures, and find test suite problems.

@leander-dsouza leander-dsouza force-pushed the add_warehouse_keepout_filter branch from 359a7ab to 3b7a703 Compare May 6, 2025 13:23
Copy link
Member

@SteveMacenski SteveMacenski left a comment

Choose a reason for hiding this comment

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

Pretty good!

@leander-dsouza leander-dsouza changed the title Add warehouse keepout filter Added keepout filter for depot and warehouse maps May 6, 2025
Copy link
Member

@SteveMacenski SteveMacenski left a comment

Choose a reason for hiding this comment

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

LGTM! Lets get this in before doing the speed zones in a follow up PR. You can open a PR against this branch if you have that done already so we can review, but it would be good to keep these 2 PRs decoupled to make it easier to review

@leander-dsouza leander-dsouza force-pushed the add_warehouse_keepout_filter branch from 0732de4 to bd3bea4 Compare May 8, 2025 22:45
Copy link
Contributor

mergify bot commented May 9, 2025

This pull request is in conflict. Could you fix it @leander-dsouza?

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>
Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>
Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>
Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>
Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>
Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>
Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>
Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>
Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>
Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>
Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>
Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>
Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>
Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>
@leander-dsouza leander-dsouza force-pushed the add_warehouse_keepout_filter branch from 3684435 to bb2ada4 Compare May 9, 2025 15:30
@SteveMacenski
Copy link
Member

After that Layer update, I think this is good to merge!

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>
@SteveMacenski
Copy link
Member

FYI @leander-dsouza now that this is default behavior, I filed a ticket about a known quirk that we may want to address. Its a bit more substantive that you can sink your teeth into if you're interested: #5139

@SteveMacenski SteveMacenski merged commit 5f34bc3 into ros-navigation:main May 9, 2025
12 of 13 checks passed
@SteveMacenski
Copy link
Member

SteveMacenski commented May 9, 2025

Done! I look forward to the speed filter next!

I think you should make a nice gif of the robot doing its thing with keepout and speed zones. That would be good to include in the Migration Guide and we can jointly announce that on LinkedIn :-)

@leander-dsouza
Copy link
Contributor Author

Done! I look forward to the speed filter next!

I think you should make a nice gif of the robot doing its thing with keepout and speed zones. That would be good to include in the Migration Guide and we can jointly announce that on LinkedIn :-)

That sounds great :)
I will make the PR for the speed filter shortly.

SteveMacenski added a commit that referenced this pull request May 13, 2025
* Pre-Commit (#4915)

* Add pre-commit

Signed-off-by: Nils-ChristianIseke <nilsmailiseke@gmail.com>

* Add codespell workflow

Signed-off-by: Nils-ChristianIseke <nilsmailiseke@gmail.com>

* Codespell write_changes=false. As otherwise CI does not fail.

Signed-off-by: Nils-ChristianIseke <nilsmailiseke@gmail.com>

* Configure isort

Signed-off-by: Nils-ChristianIseke <nilsmailiseke@gmail.com>

* add precommit

Signed-off-by: Nils-ChristianIseke <nilsmailiseke@gmail.com>

* Introducing some issues.

Signed-off-by: Nils-ChristianIseke <nilsmailiseke@gmail.com>

* Revert "Introducing some issues."

This reverts commit 5377b656361ef220dce6d6af36013060798f06de.

Signed-off-by: Nils-ChristianIseke <nilsmailiseke@gmail.com>

* Removing pre-commit workflow.

Signed-off-by: Nils-ChristianIseke <nilsmailiseke@gmail.com>

* Fix formatting error

Signed-off-by: Nils-ChristianIseke <nilsmailiseke@gmail.com>

* Merge remote-tracking branch 'origin/main' into precommit

Signed-off-by: Nils-ChristianIseke <nilsmailiseke@gmail.com>

* Change v31 to v32

Signed-off-by: Nils-ChristianIseke <nilsmailiseke@gmail.com>

* Revert "Merge remote-tracking branch 'origin/main' into precommit"

This reverts commit 8a7ca3983a0b93ef5a94e9517e9598de96be2fe6.

Signed-off-by: Nils-ChristianIseke <nilsmailiseke@gmail.com>

* Rm submodule

Signed-off-by: Nils-ChristianIseke <nilsmailiseke@gmail.com>

* pre-commit run --all after merge

Signed-off-by: Nils-ChristianIseke <nilsmailiseke@gmail.com>

---------

Signed-off-by: Nils-ChristianIseke <nilsmailiseke@gmail.com>

* Fix path comparison to avoid unnecessary updates (#5009)

Signed-off-by: Tatsuro Sakaguchi <tatsuro.sakaguchi@g.softbank.co.jp>

* nav2_rviz_plugins: Don't use non-existent slot (#5016)

The definition of the slot was removed in commit
e6f500e5 ("nav2_rviz_plugins: Remove slots without
implementation (#4974)", 2025-03-10), because it had no
implementation. But we forgot to remove the reference to this slot,
because the compiler cannot detect it.

We remove the reference now. Without this, rviz shows warnings like:

    QObject::connect: No such slot nav2_rviz_plugins::CostmapCostTool::updateAutoDeactivate()
    QObject::connect:  (sender name:   'Single click')

Signed-off-by: Michal Sojka <michal.sojka@cvut.cz>

* * Parametrize collision checking in nav2_graceful_controller (#5006)

* * Parametrize collision checking in nav2_graceful_controller

Signed-off-by: suchetanrs <suchetan.saravanan@gmail.com>

* * Fix linting errors

Signed-off-by: suchetanrs <suchetan.saravanan@gmail.com>

* * Address PR comments
* Add parameter to dynamic reconfigure

Signed-off-by: suchetanrs <suchetan.saravanan@gmail.com>

* * Add test for the use_collision_detection parameter

Signed-off-by: suchetanrs <suchetan.saravanan@gmail.com>

---------

Signed-off-by: suchetanrs <suchetan.saravanan@gmail.com>

* Update smac planner types (#4927)

* Update smac planner types

Signed-off-by: Michael Carlstrom <rmc@carlstrom.com>

* Test ament_mypy

Signed-off-by: Michael Carlstrom <rmc@carlstrom.com>

* Add packages

Signed-off-by: Michael Carlstrom <rmc@carlstrom.com>

* Fix arg name

Signed-off-by: Michael Carlstrom <rmc@carlstrom.com>

* Add **

Signed-off-by: Michael Carlstrom <rmc@carlstrom.com>

* Specific package

Signed-off-by: Michael Carlstrom <rmc@carlstrom.com>

* re-run ci

Signed-off-by: Michael Carlstrom <rmc@carlstrom.com>

* re-run ci

Signed-off-by: Michael Carlstrom <rmc@carlstrom.com>

---------

Signed-off-by: Michael Carlstrom <rmc@carlstrom.com>

* Declare_parameter_if_not_declared in docking navigator (#5023)

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Fix naming of launch file

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* Fixed naming conventions of launch file

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* navfn : fix performance issue (#4945)

Signed-off-by: Yancey <135342560+Yancey2023@users.noreply.github.com>

* Configured mypy strict for nav2_smac_planner (#5022)

* Configured mypy strict on nav2_smac_planner.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Modify workflow to contain mypy configuration.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Added dependency for type support

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

---------

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Mypy nav2 common (#5031)

* Configured mypy for nav2_common

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Added nav2_common to the workflow.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Removed all instances of Any.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Fixed unsafe fixes using ruff.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

---------

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Clear costmap if reset distance exceeds costmap bounds. (#5010)

* Migrate costmap bound check to clearArea for STVL override

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Added unbounded map to world function.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Added test for mapToWorldNoBounds

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

---------

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Add near collision cost and warnings for misaligned parameter settings in MPPI critics (#4996)

* Add warning when settings not aligned; Add tunable option for near collision

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

* Linting

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

* Add more information for warning

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

* Add test for coverage

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

* Throw controller exception instead of invalid argument

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

---------

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

* Added pre-commit with ament ignores to the workflow. (#5029)

* Added pre-commit with ament ignores to the workflow.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Removed codespell from workflow and enabled write changes in pre-commit.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Update pull request template with a testing description section.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

---------

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* feat(nav2_rotation_shim_controller): add use_path_orientations (#5034)

* feat(nav2_rotation_shim_controller): add use_path_orientations

Signed-off-by: Kemal Bektas <kemal.bektas@node-robotics.com>

* Update nav2_rotation_shim_controller/src/nav2_rotation_shim_controller.cpp

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

---------

Signed-off-by: Kemal Bektas <kemal.bektas@node-robotics.com>
Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>
Co-authored-by: Kemal Bektas <kemal.bektas@node-robotics.com>
Co-authored-by: Steve Macenski <stevenmacenski@gmail.com>

* Mypy nav2 bringup (#5040)

* Configured nav2_bringup to be compatible with mypy.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Added nav2_bringup to the linting workflow.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

---------

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Add service introspection (#4955)

* Add service introspection for client and server side, more tests to go

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

* Add test for service server, fix repeat declaration

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

* Fix cpplint

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

* Add test for coverage

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

* Declare and set the parameter in service client and server class

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

* Add typedef; Fix costmap cost tool and bt service

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

* Rebase; Add tests for coverage

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

* Fix costmap cost tool; Typedef

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

* Cleanup

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

* Add spin thread

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

* Add spin

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

* Change spin thread to internal executor

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

* Use rclcpp spin when no internal executor

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

* Update nav2_util/include/nav2_util/service_client.hpp

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* Update nav2_util/include/nav2_util/service_client.hpp

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* Update nav2_util/include/nav2_util/service_client.hpp

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* Update nav2_util/include/nav2_util/service_client.hpp

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* Refactor

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

* Update nav2_util/include/nav2_util/service_client.hpp

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

---------

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>
Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>
Co-authored-by: Steve Macenski <stevenmacenski@gmail.com>

* Mypy nav2_collision_monitor (#5043)

* Configured nav2_collision_monitor to use mypy strict.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Added nav2_collision_monitor to the workflow.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

---------

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Mypy nav2 costmap 2d (#5044)

* Configured mypy to run on the costmap_2d package.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Added mypy_nav2_costmap_2d to the workflow.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

---------

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Halt recovery action when main action succeeds to reset status (#5027)

* Halt recovery action when main action succeeds to reset status

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* Update nav2_behavior_tree/plugins/control/recovery_node.cpp

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

---------

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* Mypy opennav_docking (#5047)

* Define attributes for nav2_msgs.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Configured opennav_docking to use strict mypy.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Added opennav_docking to the mypy linting workflow.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

---------

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Remove unused code in BT utils (#5048)

* Clean set port

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Remove set

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

---------

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Mypy nav2 lifecycle manager (#5051)

* Configured nav2_lifecycle_manager to be compatible with mypy

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Added nav2_lifecycle_manager to the workflow.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

---------

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* fix initializing in drive on heading action node (#5053)

Signed-off-by: Johannes Plapp <johannes.plapp@logivations.com>

* Mypy nav2 loopback sim (#5052)

* Configured nav2_loopback_sim to be compatible with mypy.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Added nav2_loopback_sim to the workflow.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Separated packages from list for mypy workflow.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

---------

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Fix mppi bidirectional settings (#4954)

* Add constraint; fix settings

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

* Add lower and upper bound

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

* Update tests

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

* Update nav2_mppi_controller/include/nav2_mppi_controller/motion_models.hpp

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* Update nav2_mppi_controller/include/nav2_mppi_controller/motion_models.hpp

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* Update nav2_mppi_controller/include/nav2_mppi_controller/motion_models.hpp

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* Update nav2_mppi_controller/include/nav2_mppi_controller/motion_models.hpp

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

---------

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>
Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>
Co-authored-by: Steve Macenski <stevenmacenski@gmail.com>

* Mypy nav2 map server (#5058)

* Configured nav2_map_server to be mypy compliant.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Added nav2_map_server to the mypy workflow.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

---------

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Publishing a full time-series MPPI trajectory if desirable (#5057)

* Publishing a full MPPI trajectory if desirable

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* only create publisher when needed

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* adjust topics

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* Moving for lint

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* updating topics in tests

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

---------

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* Add double spin_some in some BT nodes (#5055)

* Add a double spin

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Add comment

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Move spin to constructor

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

---------

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Remove duplicate test (#5062)

There remained a duplicate test of test_system_launch after Groot
monitoring was removed

Signed-off-by: Rasmus Larsson <rasmus.larsson@accenture.com>

* Remove docking absolute topic namespaces (#5068)

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* Mypy nav2 simple commander (#5059)

* Added most nav2_simple_commander files that can be trivially converted to be mypy compatible.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Modified edge cases and types for robot_navigator to pass mypy checks.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Added nav2_simple_commander to the linting workflow.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Added logs and ignored type errors due to spins w/o timeout.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

---------

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Make NavigateThroughPoses navigator report waypoint statuses information. (fix #4846) (#4994)

* Add WaypointStatus message type & Remove MissedWaypoint message type

Signed-off-by: zz990099 <771647586@qq.com>

* Add waypoint_statuses records in RemoveInCollisionGoals/RemovePassedGoals actions

Signed-off-by: zz990099 <771647586@qq.com>

* Add validation tests

Signed-off-by: zz990099 <771647586@qq.com>

* Make NavigateThroughPoses navigator report waypoint statuses information

Signed-off-by: zz990099 <771647586@qq.com>

* Make WaypointFollower use WaypointStatus message type in action result

Signed-off-by: zz990099 <771647586@qq.com>

* Split MISSED status into SKIPPED & FAILED

Signed-off-by: zz990099 <771647586@qq.com>

* fix edge case handle in RemoveInCollision/RemovePassed BT actions

Signed-off-by: zz990099 <771647586@qq.com>

* Add validation test cases for RemoveInCollision&RemovePassed BT actions

Signed-off-by: zz990099 <771647586@qq.com>

* Update RemovePassedGoals/RemoveInCollisionGoals node in Groot XML

Signed-off-by: zz990099 <771647586@qq.com>

---------

Signed-off-by: zz990099 <771647586@qq.com>

* Enable Groot2 monitoring (#5065)

* Revert removing live groot monitoring from Nav2 (#2696)

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Update to Groot2

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Added JSON conversions

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Fix rebase

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Update to nav_msgs::Goals

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Added nav_msgs to json utils

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Add register to types

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Fix null-dereference

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Added Json test

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Fix some tests

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Fix flake

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Update package dependency

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Minor fixes

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Fix test

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Rename groot_publisher_port parameter to groot_server_port

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Minor  fix in tst

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Added JSON for waypoint_status

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

---------

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Fix incorrect world <-> map coordinates conversions (#5049)

* Fix incorrect world <-> map coordinates conversions

The conversion between world and map continuous (!) coordinates do not
require a +/-0.5. This offset is only required when converting discrete
map cell indexes to the coordinates of its center.

Signed-off-by: Dylan De Coeyer <dylan.decoeyer@quimesis.be>

* nav2_smac_planner: fix smoother test when path is in collision

The added pose was indeed invalid, but the it was ignored by the
smoother, since considered as a cusp.

Instead, let's make the end of the plan invalid as it won't be ignored.
Also, let's duplicate the last pose to make the orientation estimation
fail, rather than adding a new arbitrary pose.

Signed-off-by: Dylan De Coeyer <dylan.decoeyer@quimesis.be>

---------

Signed-off-by: Dylan De Coeyer <dylan.decoeyer@quimesis.be>

* [AMCL] 50% initialisation (and reset) speed improvement  (#4941)

* index lookup and comparator optimisation

Signed-off-by: Guillaume Doisy <guillaume@dexory.com>

* lint

Signed-off-by: Guillaume Doisy <guillaume@dexory.com>

---------

Signed-off-by: Guillaume Doisy <guillaume@dexory.com>
Co-authored-by: Guillaume Doisy <guillaume@dexory.com>

* Add note to Asynchronous nodes (#5035)

* Add warning to some of the nodes

Signed-off-by: Adi Vardi <adi.vardi@enway.ai>

* remove unused includes

Signed-off-by: Adi Vardi <adi.vardi@enway.ai>

* Add warning to remaining nodes using isStatusActive to initialize

Signed-off-by: Adi Vardi <adi.vardi@enway.ai>

* Change to note & update phrsing

Signed-off-by: Adi Vardi <adi.vardi@enway.ai>

* replace reset by re-initialize

Signed-off-by: Adi Vardi <adi.vardi@enway.ai>

---------

Signed-off-by: Adi Vardi <adi.vardi@enway.ai>

* [AMCL] Rebuild cspace map only when needed (#5076)

* for LikelihoodFieldModel

Signed-off-by: Guillaume Doisy <guillaume@dexory.com>

* for LikelihoodFieldModelProb

Signed-off-by: Guillaume Doisy <guillaume@dexory.com>

* typo

Signed-off-by: Guillaume Doisy <guillaume@dexory.com>

* init max_occ_dist in map.c and remove unnecessary condition

Signed-off-by: Guillaume Doisy <guillaume@dexory.com>

---------

Signed-off-by: Guillaume Doisy <guillaume@dexory.com>
Co-authored-by: Guillaume Doisy <guillaume@dexory.com>

* Consistency in Groot 2 (#5078)

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Remove duplicate code (#5080)

* Remove duplicate code

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

* Add twist validation for controller server

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

---------

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

* Added waypointstatus to bt_utils (#5077)

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Lock costmap in getCostsCallback (#5075)

* Add IsStoppedBTNode

Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com>

* add topic name + reformat

Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com>

* fix comment

Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com>

* fix abs

Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com>

* remove log

Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com>

* add getter functions for raw twist

Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com>

* remove unused code

Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com>

* use odomsmoother

Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com>

* fix formatting

Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com>

* update groot

Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com>

* Add test

Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com>

* reset at success

Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com>

* FIX velocity_threshold_

Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com>

* Fix stopped Node

Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com>

* Add tests  to odometry_utils

Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com>

* fix linting

Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com>

* lock costmap

Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com>

* improvement

Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com>

* remove spacing

Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com>

* remove unlock

Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com>

---------

Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com>

* Mypy nav2 system tests (#5083)

* Configured nodes of nav2_system_tests to be mypy compliant.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Configured launch files of nav2_system_tests to be mypy compliant.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Added nav2_system_tests to the linting workflow.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

---------

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Configure the entire nav2 stack with mypy (#5084)

* Configured tools to be mypy compliant.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Added mypy as a pre-commit hook.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Simplified workflow by including all packages with mypy.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

---------

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Dynamic param patterns (#4971)

* redesign dynamic param patterns

Signed-off-by: Nils-ChristianIseke <nilsmailiseke@gmail.com>

* change cache version

Signed-off-by: Nils-ChristianIseke <nilsmailiseke@gmail.com>

* check that parameter of type double are  >=0.0

Signed-off-by: Nils-ChristianIseke <nilsmailiseke@gmail.com>

---------

Signed-off-by: Nils-ChristianIseke <nilsmailiseke@gmail.com>

* [nav2_behavior_tree] Add force_use_current_pose to ComputePathToPoseAction (#4925)

* Add force_use_current_pose

Signed-off-by: Guillaume Doisy <guillaume@dexory.com>

* xml update

Signed-off-by: Guillaume Doisy <guillaume@dexory.com>

* rename to use_start

Signed-off-by: Guillaume Doisy <guillaume@dexory.com>

* lint

Signed-off-by: Guillaume Doisy <guillaume@dexory.com>

* descriptions

Signed-off-by: Guillaume Doisy <guillaume@dexory.com>

* simplify logic

Signed-off-by: Guillaume Doisy <guillaume@dexory.com>

---------

Signed-off-by: Guillaume Doisy <guillaume@dexory.com>
Co-authored-by: Guillaume Doisy <guillaume@dexory.com>

* [CostmapTopicCollisionChecker] Alternative constructor with footprint string (#4926)

* [CostmapTopicCollisionChecker] Alternative constructor with footprint

Signed-off-by: Guillaume Doisy <guillaume@dexory.com>

* raw pointer

Signed-off-by: Guillaume Doisy <guillaume@dexory.com>

* suggestions from review

Signed-off-by: Guillaume Doisy <guillaume@dexory.com>

---------

Signed-off-by: Guillaume Doisy <guillaume@dexory.com>
Co-authored-by: Guillaume Doisy <guillaume@dexory.com>

* Merged Fix navfn_planner from humble PR #5087 (#5092)

* merged changes from humble for goal.header fix

* reverted back, error in merge

* ported goal.header fix in navfn_planner.cpp from humble

* reverted to navfn_planner.cpp to origin/main

* merged navfn_planner.cpp from humble

* fixed the merge

* Docking backwards as plugin param (#5079)

* Replace dock_backwards_ param with dock plugin function

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Deprecated dock_backwards warning

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Convert dockDirection from bool to enum

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Minor fixes

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Improve deprecated param handling

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Set default to forward

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Added tests

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Update nav2_docking/README.md

Co-authored-by: Steve Macenski <stevenmacenski@gmail.com>
Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Upper and others

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Revert declare_parameters_from_overrides

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Added throw on configure plugin

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Remove node_utils

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

---------

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>
Co-authored-by: Steve Macenski <stevenmacenski@gmail.com>

* Update map_io library to use Eigen method for faster map loading (#5071)

* Update map_io library to use opencv method for faster map loading

Signed-off-by: Vignesh T <vignesh.t@kabam.ai>

* Update pre-commit config changes

Signed-off-by: Vignesh T <vignesh.t@kabam.ai>

* Use Eigen approach instead of OpenCV

Signed-off-by: Vignesh T <vignesh.t@kabam.ai>

* Update pre-commit changes

Signed-off-by: Vignesh T <vignesh.t@kabam.ai>

* Update include header include order

Signed-off-by: Vignesh T <vignesh.t@kabam.ai>

* Remove intermediary alpha matrix

Signed-off-by: Vignesh T <vignesh.t@kabam.ai>

* Add comments for the code understanding

Signed-off-by: Vignesh T <vignesh.t@kabam.ai>

* Fix else braces rule issue

Signed-off-by: Vignesh T <vignesh.t@kabam.ai>

* Create and use alpha_matrix when applying mask

Signed-off-by: Vignesh T <vignesh.t@kabam.ai>

* Update pre-commit changes

Signed-off-by: Vignesh T <vignesh.t@kabam.ai>

* Take flip part out of if-else

Signed-off-by: Vignesh T <vignesh.t@kabam.ai>

* Update pre-commit changes

Signed-off-by: Vignesh T <vignesh.t@kabam.ai>

---------

Signed-off-by: Vignesh T <vignesh.t@kabam.ai>

* Fix CI builds (#5104)

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* Increase docking coverage && fix backward docking (#5097)

* Add dock_database tests

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Add utils test

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Improve filter tests

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Added simple charging tests

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Improve comments

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Fix backward and redo main test

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Change test period to reduce test time

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Revert "Change test period to reduce test time"

This reverts commit ef1555ec43cb4849fd658c32377189cf414ff9b7.

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Delete print pose

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

---------

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>

* Initialize dock backwards (#5114)

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* Precompute yaw trigonometric values in smac planner (#5109)

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

* Nav2 Route Server (#5056)

* skeleton of main server and visualization tools

* adding complete Kd-tree search for initial and goal node iDs for search

* initial planner complete

* added path converter

* fix conversion util

* adding change graph service

* added edge scoring to the search + pluginlib definitions + a plugin example instance

* moved to src directory

* linting

* contextual error codes + default bringup

* adding rviz default views of rgaph

* adding missing exception file

* fix segfault that was previously optimized out

* whoops, removing duplicate plugin registration

* remove nanoflann TODO

* adding 2 more edge plugins, use of closed edges in the API design, and added service to modify a set of closed edges being tracked

* fix indexing bug for certain request types

* adding costmap scoring route plugin

* readme todo list updates

* readme details

* adding unit test coverage

* add dynamic cost adjustment by application systems

* adding in operations API

* minor fixes

* add compute and track route action def

* initial prototype compiling and basic interface working for tracking action

* updates to TODO list

* state management

* remove divide by zero potential error

* added in working mostly  demog

* adding rerouting service and a bunch of new tests for operations

* adding new trigger event plugin + base class for service calls + test coverage to complete operations manager

* conventions

* adding initial (maybe working?) collision checker + added blocked ID propogation from operations to allow for rerouting with info from operations

* adding in 3 new algorithms: Time Scorer, Time Marker, and Semantic Scorer

* adding complete unit testing for collision monitor

* adding tests for the planner on a fully connected 4x4 graph

* adding rereouting with starting point to use for the initial condition when along route

* sharing common shared action server code in main server

* refactor, added goal intent extractor, updated necessary tests

* updating todo notes

* adding tests and functionoing goal intent extractor and pruning cost updates

* a little cleanup

* adding readme

* completing unit tests

* large reorg of information around the rerouting state information and output formats for practical use

* Nav2 route server parser (#3398)

* aws graph working

* graph parser first stage

* naming cleanup

* remove

* update graph file

* added fileExists to api

* moved filepath param

* vect to string

* parser cleanup

* debug log

* added tests for geojson graph parser

* added logging to parser

* cleanup

* catch exceptions in route service

* code review

* undo cmake

* added graph loader test

* undo cmake

* code review

* frame convesion support

* comments

* fix

* Parse edge and node metadata

* parse operations

* completed metadata parsing

* added recursion for parser

* code review

* undo cmake

* support vectors

* refactor tests

* fix

* general cleanup

* code review

* added timestamp

---------

Co-authored-by: Steve Macenski <stevenmacenski@gmail.com>

* adding unit tests for complex handling of reentrant requests

* adding demos for python3 API

* adding conditions if graph is empty in routing request

* working MVP tracking demos working

* adding integration testing expanded TODO list before beta testers

* Example graph (#3438)

* added simple graph

* added metadata and operations to graph

* update

* add space

* added test for sample_graph

* added to readme

* testing system-wise, mostly working

* update remaining TODO list

* updates for pruning starting in rerouting

* adding a full roster of default plugins

* complete tested feature set

* adding configuration guide to readme

* adding plugins info

* testing collapse

* smaller titles

* adding becnhmarking script

* adding metrics to readme

* adding image for architecture

* resize

* resize

* adding design info

* new image

* turtlebot3 world graph (#3472)

* turtlebot3 world graph

* remove line

* add line back

* scripts for route (#3490)

* tmp push for moving computers

* Nav2 route server goal orientation scorer (#4866)

* added goal pose and bool to check for last edge for all scorers

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* added goal_orientation scorer

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* added test for GoalOrientationScorer

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* changed goal pose to a const ref, and moved score to end as implicit return

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* changed goal arguments to const ref

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* using const ref for goal pose, rearranged total_score to match header

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* linting on goal_orientation_scorer.hpp

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* using M_PI as default threshold, fixed angle wrapping by using angles library, no longer modifying cost

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* changed arguments to use const refs, changed argument order in score function to matach header

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* changed calling of score to match argument sequence, changed GoalOrientaitonScorer to test the opposite direction and check the return value

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* switched cost edge pairs to imply return of cost, default orientation as M_PI / 2.0

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

---------

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* minor updates

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* fix a few bugs, clarify a few things

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* more validation and inline comments to help readers understand complex interactions

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* CI turning over

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* adding error_msg

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* updated cmake style to be in line with repo

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* Adding afew mores features from TODO list

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* Nav2 route server start pose orientation scorer (#4950)

* adding flag to identify start node, passing tf_buffer to edge scorer

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* passing tf to route planner

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* added null buffer to tests

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* added null buffer to planner configure in performance bench marking test

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* changed arguments of all old edge scorers to also take tf_buffer

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* changed configure to take tf_buffer, added bool to identify start_edge in score method for all existing edge scorers

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* added start_pose_orientation_scorer to CMake

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* added StartPoseOrientationScorer as and edge scroer

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* added tf_buffer to constructor, added start edge bool on score method, added tf_buffer as a protected variable

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* added tf_buffer to configure method, added start_id_ member variable, added isStart method to identify initial node for route_planner.hpp

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* modified all configures to take a tf_buffer, modified all score functions to take a start edge bool, added test for start_pose_orientation_scorer

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* adding start_pose_orientation_scorer.cpp

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* edge scorer modified to take in tf_buffer and pass it to scorer plugins, bool for start edge also passed down to plugins

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* removed redundant parameter declarations, changed robot frame to base frame, year bump

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* changed robot frame to base frame, year bump on copy right

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* removed unnecessary tf_buffer_ from edge_scorer

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* added EdgeType enum class

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* all edge scorer plugins changed to use EdgeType

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* edge_scorer modified to use EdgeType enum class

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* edge_cost_function base class modified to use EdgeType enum class

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* modified tests for new scorer signature

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* added method to classify edge type

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* ament_cpplinting

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* linting

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* changed EdgeType to const ref

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* added option to score orientations instead of outright rejecting start poses

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* updated docstrings to have better description for goal pose and start pose orientation goal checker

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* fixed merge conflict in goal_orientation_scorer.hpp

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* fixed merge conflict in edge_cost_function.hpp

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* removed TODO from costmap_scorer.cpp

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* added getStart method to goal_intent_extract and start pose argument for findRoute

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* added RouteData struct to types.hpp

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* added start_pose to edge scorer hpp and cpp

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* fixed type getStart return type in goal_intent_extractor.cpp

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* added passing of start_pose down to scorer in route_planner

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* added start pose to base edge cost function class

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* underscore fix for goal_intent_extractor_

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* changed signature of all edge cost functions to take start_pose

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* populating RouteData and passing it into findRoute

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* passing route_data down to getTraversalCost

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* plugins modified to take in route_data, tests updated accordingly

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* using route data for goal_orientation_scorer and start_pose_orientation_scorer, modified tests accordingly

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* removed route frame, robot frame, and getRobotPose from start_pose_orientation_scorer

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* removed used of stat_pose and goal_pose as it is replaced with route data

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* added InvalidCriticUse exception to nav2_core, goal_orientation_scorer and start_pose_orientation_scorer throws this exception if route_data.use_poses is false, route_server catches this exception, added exception test in the edge scorer tester

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* added INVALID_CRITIC_USE error code in route actions

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* added orientation weighting for cost as an option instead of out right rejection

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* updated docstring for goal orientation scorer

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* renamed Critic to EdgeScorer

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* changed Critic to EdgeScorer in edge cost functions

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* changed Critic to EdgeScorer, storing exception message in error msg

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* changed Critic to EdgeScorer in edge scorer tests

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* changed INVALID_CRITIC_USE to IVALID_EDGE_SCORER_US in actions

* changed RouteData and route_data to RouteRequest and route_request respectively, added doxygen for RouteRequest struct

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* added doxygen for EdgeType

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

---------

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>

* updates

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* better handle the route situation in the simple commander API

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* completed TB4 migration

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* route updates

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* updating radme

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* one last comment for the day

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* adding in BT ndoes, tests, and graphs for bringup

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* updating error code locations

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* test for route planner complete

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* Update to use service server from nav2_utils for service introspection

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* fix small error

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* adding in additional smoke tests, prototype working of tracking test to be continued

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* updates

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* completed system tests

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* reenable collision checking

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* remove unnecssary logging

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* linting

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* Update package.xml

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* closing test gap

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* a few more lines

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* changing permissions

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* fix system test

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* adding in additional coverage

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* finalized test coverage

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* adding file

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* simple commander demo working

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* python happiness

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* precommit spelling happy

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* wtf pprecommit, why didn't you mention this before

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* spelling

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* Update nav2_route/README.md

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* Update route_planner.cpp

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* fix mistake in merge conflict resolution

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* type check fix

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* lint

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* linting

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* more design ideas

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* Configuring nav2_route_server branch to be mypy compliant (#5081)

* Added definitions for nav2_msgs actions and messages.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Enabled example_route to be compatible with mypy.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Added return definition for route_example_launch.py.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Ported robot_navigator.py to be compliant with mypy.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

---------

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Demo 1 completed

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* second demo completed

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* final linting

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* adding route server for test to pass

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* adding smoother server

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* Configured nav2_system_tests to be mypy compliant. (#5085)

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Route Tool Rviz Panel (#4775)

* added route tool skeleton code and gui

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* rviz2 panel can load route graph

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* can add nodes using route tool

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* added logic for creating edges

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* graph nodes can be edited, existing edges will still connect if a node is moved

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* can edit edges

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* can delete nodes and edges

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* route graphs can be saved

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* fixed bug for loading in route graphs

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* added dynamic text to UI, created launch file and rviz configuration

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* fixed bug for deleting nodes

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* actually fixed node removal bug

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* publishing clicked point populates x and y fields

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* removed debugging log statements

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* added check to make sure node/edges exist before editing

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* bug fix

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* migrated route tool to rviz plugin

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* minor refactoring

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* added metadata and operations to graph saver so nothing should be erased

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* edited set route service to clear current route before setting new

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* Update README.md

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* addressed comments

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* documentation cleanup

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* changed copyright

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* addressed comments

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* moved copyright due to compiler error

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* revert removal of files

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* added gen ai comment

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* fixed rebasing issue

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* fix linting errors

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* added export for graph saver dependencies

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* added ui file to library

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* added nav2_route_core to link libaries

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* fixed cmake error

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* fixed build issues

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* uncrustified

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* cpplint

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* added unit tests and fixed bugs

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* increased test coverage

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* fixed linter errors

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* fixed pre-commit errors

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* fixed formatting error

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* double -> single quotes

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* added test for using default filepath

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* fixed license

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* addressed comments

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* Update nav2_route/include/nav2_route/graph_saver.hpp

Co-authored-by: Steve Macenski <stevenmacenski@gmail.com>
Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* Update nav2_route/src/plugins/graph_file_savers/geojson_graph_file_saver.cpp

Co-authored-by: Steve Macenski <stevenmacenski@gmail.com>
Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* Update nav2_route/src/plugins/graph_file_savers/geojson_graph_file_saver.cpp

Co-authored-by: Steve Macenski <stevenmacenski@gmail.com>
Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* Update nav2_route/src/plugins/graph_file_savers/geojson_graph_file_saver.cpp

Co-authored-by: Steve Macenski <stevenmacenski@gmail.com>
Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* Update nav2_route/src/plugins/graph_file_savers/geojson_graph_file_saver.cpp

Co-authored-by: Steve Macenski <stevenmacenski@gmail.com>
Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

* linter fix

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>

---------

Signed-off-by: John Chrosniak <chrosniakj@gmail.com>
Co-authored-by: Saikrishna Bairamoni <84093461+SaikrishnaBairamoni@users.noreply.github.com>
Co-authored-by: Steve Macenski <stevenmacenski@gmail.com>

* fixing linting

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* Updating readme table

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* lint

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* adding multifloor

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* adding BFS goal intent search

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* fix bug

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* adding unit tests for goal intent search

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* fixing collision check

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* Update nav2_simple_commander/nav2_simple_commander/robot_navigator.py

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

---------

Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>
Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>
Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>
Signed-off-by: John Chrosniak <chrosniakj@gmail.com>
Co-authored-by: Joshua Wallace <josho.wallace@gmail.com>
Co-authored-by: alexanderjyuen <103065090+alexanderjyuen@users.noreply.github.com>
Co-authored-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>
Co-authored-by: John Chrosniak <chrosniakj@gmail.com>
Co-authored-by: Saikrishna Bairamoni <84093461+SaikrishnaBairamoni@users.noreply.github.com>

* Feat/smac planner include orientation flexibility (#4127)

* include functionality to allow multiple goal heading for smac planner

Signed-off-by: stevedanomodolor <stevedan.o.omodolor@gmail.com>

* include missing parameter inclusion

Signed-off-by: stevedanomodolor <stevedan.o.omodolor@gmail.com>

* increase test coverage

Signed-off-by: stevedanomodolor <stevedan.o.omodolor@gmail.com>

---------

Signed-off-by: stevedanomodolor <stevedan.o.omodolor@gmail.com>

* Support zero value for std_wz in mppi controller (#5110)

* Support zero value for std_wz in mppi controller

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

* Update for better readability

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

---------

Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>

* Update update_ci_image.yaml to include jazzy build (#5120)

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* Update update_ci_image.yaml to add humble

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* message_filters hpp headers have been backported (#5127)

* message_filters hpp headers have been backported

Signed-off-by: Tim Clephas <tim.clephas@nobleo.nl>

* fixup! message_filters hpp headers have been backported

Signed-off-by: Tim Clephas <tim.clephas@nobleo.nl>

---------

Signed-off-by: Tim Clephas <tim.clephas@nobleo.nl>

* Update PULL_REQUEST_TEMPLATE.md

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* Bibtex formatting (#5126)

* Align citation text to be within the bullet points.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Align formatting to match bibtex guide.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Add justified spacing for readability.
Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

---------

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Make sure fixed curvature lookahead distance doesn't overshoot distance to cusp (#5134)

Related issue: https://github.com/ros-navigation/navigation2/issues/5098

* removing the start navigation message in the paused state from rviz buttons (#5137)

Signed-off-by: Pradheep <padhupradheep@gmail.com>

* Added keepout filter for depot and warehouse maps (#5125)

* Added keepout region to warehouse map.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Support keepout_map as a launch argument.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Added a dictionary to switch between tb4 maps.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Added dedicated launch file for map modifiers.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Added support for depot keepout filter.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Updated keepout masks for depot and warehouse.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Renamed keepout filter launch arguments to keepout zones.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Renamed keepout map launch argument to keepout mask

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Renamed map_modifier.launch.py to keepout_zone_launch.py.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Preserve duplication of nodes for keepout test.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Removed padding from keepout zones from depot map.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Added keepout zone at the centre of the warehouse map.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Added utility script to handle namespaces for keepout_filter.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Used utility function to simplify namespace calls.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Moved joinWithParentNamespace to the Layer object.

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

---------

Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>

* Fix lattice backward 180 deg issue (#5141)

Signed-off-by: selazarev <slazarev8@gmail.com>

* [lifecycle_manager] expose service_timeout (#4838)

* [lifecycle_manager] expose service_timeout

Signed-off-by: Guillaume Doisy <guillaume@dexory.com>

* restore original change_state, and detect non_default_timeout

Signed-off-by: Guillaume Doisy <guillaume@dexory.com>

* lint

Signed-off-by: Guillaume Doisy <guillaume@dexory.com>

* spell

Signed-off-by: Guillaume Doisy <guillaume@dexory.com>

* collapse change_state and remove non_default_timeout logic

Signed-off-by: Guillaume Doisy <guillaume@dexory.com>

* Update nav2_util/src/lifecycle_service_client.cpp

Co-authored-by: Steve Macenski <stevenmacenski@gmail.com>
Signed-off-by: Guillaume Doisy <doisyg@users.noreply.github.com>

---------

Signed-off-by: Guillaume Doisy <guillaume@dexory.com>
Signed-off-by: Guillaume Doisy <doisyg@users.noreply.github.com>
Co-authored-by: Guillaume Doisy <guillaume@dexory.com>
Co-authored-by: Steve Macenski <stevenmacenski@gmail.com>

* Update simple_action_server.hpp for description (#5150)

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

* reset motion model (#5149)

Signed-off-by: Adi Vardi <adi.vardi@enway.ai>

* Show error if inflation radius is smaller than circumscribed radius (#5148)

* Warn if inflation radius is smaller than circumscribed radius

Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com>

* Update nav2_mppi_controller/src/critics/cost_critic.cpp

Co-authored-by: Steve Macenski <stevenmacenski@gmail.com>
Signed-off-by: Tony Najjar <t03578624@gmail.com>

* Update nav2_smac_planner/include/nav2_smac_planner/utils.hpp

Co-authored-by: Steve Macenski <stevenmacenski@gmail.com>
Signed-off-by: Tony Najjar <t03578624@gmail.com>

---------

Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com>
Signed-off-by: Tony Najjar <t03578624@gmail.com>
Co-authored-by: Steve Macenski <stevenmacenski@gmail.com>

---------

Signed-off-by: Nils-ChristianIseke <nilsmailiseke@gmail.com>
Signed-off-by: Tatsuro Sakaguchi <tatsuro.sakaguchi@g.softbank.co.jp>
Signed-off-by: Michal Sojka <michal.sojka@cvut.cz>
Signed-off-by: suchetanrs <suchetan.saravanan@gmail.com>
Signed-off-by: Michael Carlstrom <rmc@carlstrom.com>
Signed-off-by: Alberto Tudela <ajtudela@gmail.com>
Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>
Signed-off-by: Yancey <135342560+Yancey2023@users.noreply.github.com>
Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>
Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>
Signed-off-by: Kemal Bektas <kemal.bektas@node-robotics.com>
Signed-off-by: Johannes Plapp <johannes.plapp@logivations.com>
Signed-off-by: Rasmus Larsson <rasmus.larsson@accenture.com>
Signed-off-by: zz990099 <771647586@qq.com>
Signed-off-by: Dylan De Coeyer <dylan.decoeyer@quimesis.be>
Signed-off-by: Guillaume Doisy <guillaume@dexory.com>
Signed-off-by: Adi Vardi <adi.vardi@enway.ai>
Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com>
Signed-off-by: Vignesh T <vignesh.t@kabam.ai>
Signed-off-by: Alexander Yuen <alex@polymathrobotics.com>
Signed-off-by: John Chrosniak <chrosniakj@gmail.com>
Signed-off-by: stevedanomodolor <stevedan.o.omodolor@gmail.com>
Signed-off-by: Tim Clephas <tim.clephas@nobleo.nl>
Signed-off-by: Pradheep <padhupradheep@gmail.com>
Signed-off-by: selazarev <slazarev8@gmail.com>
Signed-off-by: Guillaume Doisy <doisyg@users.noreply.github.com>
Signed-off-by: Tony Najjar <t03578624@gmail.com>
Co-authored-by: Nils-Christian Iseke <48475933+Nils-ChristianIseke@users.noreply.github.com>
Co-authored-by: Tatsuro Sakaguchi <tatsuro.sakaguchi@g.softbank.co.jp>
Co-authored-by: Michal Sojka <michal.sojka@cvut.cz>
Co-authored-by: Michael Carlstrom <rmc@carlstrom.com>
Co-authored-by: Alberto Tudela <ajtudela@gmail.com>
Co-authored-by: Steve Macenski <stevenmacenski@gmail.com>
Co-authored-by: Yancey <135342560+Yancey2023@users.noreply.github.com>
Co-authored-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com>
Co-authored-by: mini-1235 <mauricepurnawan@gmail.com>
Co-authored-by: Kemal Bektas <34746077+bektaskemal@users.noreply.github.com>
Co-authored-by: Kemal Bektas <kemal.bektas@node-robotics.com>
Co-authored-by: Johannes Plapp <johannes.plapp@logivations.com>
Co-authored-by: RasmusLar <101558931+RasmusLar@users.noreply.github.com>
Co-authored-by: zz99 <86543200+zz990099@users.noreply.github.com>
Co-authored-by: DylanDeCoeyer-Quimesis <102609575+DylanDeCoeyer-Quimesis@users.noreply.github.com>
Co-authored-by: Guillaume Doisy <doisyg@users.noreply.github.com>
Co-authored-by: Guillaume Doisy <guillaume@dexory.com>
Co-authored-by: Adi Vardi <57910756+adivardi@users.noreply.github.com>
Co-authored-by: Tony Najjar <tony.najjar.1997@gmail.com>
Co-authored-by: Sandeep Dutta <quark01@gmail.com>
Co-authored-by: Vignesh T <vignesh.t@kabam.ai>
Co-authored-by: Joshua Wallace <josho.wallace@gmail.com>
Co-authored-by: alexanderjyuen <103065090+alexanderjyuen@users.noreply.github.com>
Co-authored-by: John Chrosniak <chrosniakj@gmail.com>
Co-authored-by: Saikrishna Bairamoni <84093461+SaikrishnaBairamoni@users.noreply.github.com>
Co-authored-by: Stevedan Ogochukwu Omodolor <61468301+stevedanomodolor@users.noreply.github.com>
Co-authored-by: Tim Clephas <tim.clephas@nobleo.nl>
Co-authored-by: moooeeeep <moooeeeep@users.noreply.github.com>
Co-authored-by: Pradheep Krishna <padhupradheep@gmail.com>
Co-authored-by: Semyon <slazarev8@gmail.com>
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