-
Notifications
You must be signed in to change notification settings - Fork 1.6k
Dynamic param patterns #4971
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
Dynamic param patterns #4971
Conversation
Codecov ReportAttention: Patch coverage is
... and 5 files with indirect coverage changes 🚀 New features to boost your workflow:
|
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
Otherwise, looks good to me! It might be valuable as part of this work to also add in other parameter validations while we're making these changes and auditing dynamic parameters. For example:
- Are all parameters set as dynamic parameters? If not, should those missing ones be dynamic?
- Are there other range checks that should be made for parameters?
It might be worth adding to the ticket a checklist of all the nodes that need updating and we can have that discussion for each to make sure we fill any obvious gaps currently missing due to updates over time where parameters were mistakenly not added or some validation checks that might be good to have
nav2_regulated_pure_pursuit_controller/src/parameter_handler.cpp
Outdated
Show resolved
Hide resolved
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
Otherwise, this is a good template to use for other future ports!
nav2_regulated_pure_pursuit_controller/src/parameter_handler.cpp
Outdated
Show resolved
Hide resolved
a61b571 to
589474c
Compare
|
@SteveMacenski i am not sure if i like the approach of 589474c. What is your opinion on it? |
|
@Nils-ChristianIseke, your PR has failed to build. Please check CI outputs and resolve issues. |
1 similar comment
|
@Nils-ChristianIseke, your PR has failed to build. Please check CI outputs and resolve issues. |
nav2_regulated_pure_pursuit_controller/src/parameter_handler.cpp
Outdated
Show resolved
Hide resolved
I'm in the same boat as you; I don't know that I like it either. The declares I like better than the gets, considering the param vectors are separated by types. I do like the simplicity of the below though: However, I think if we did something like this, I think we should have an internal struct within the param handler quick includes everything: the parameter name, its default, its value, the setter lambda, and update validation lambda. That way, we define that once and its used for declare/get/dynamic parameter update/dynamic parameter validation. The repeated vector lists I think make it less readable to a casual developer compared to what's already there with declare/get calls that are pretty standard across ROS 2. Something potentially nice about that is that we could register that map with the FYI you might be interested in https://github.com/PickNikRobotics/generate_parameter_library. I'm not sure I love this method (what if we want more custom parts of our parameter handler, like wanting to mutex lock parameter access for multi-threaded situations where the dynamic parameter executor is different from the running executor) -- but maybe those are handled and/or you see value/inspiration here |
ae85416 to
7738e2d
Compare
|
@Nils-ChristianIseke, your PR has failed to build. Please check CI outputs and resolve issues. |
|
This pull request is in conflict. Could you fix it @Nils-ChristianIseke? |
Signed-off-by: Nils-ChristianIseke <nilsmailiseke@gmail.com>
89c6349 to
722dd6d
Compare
Signed-off-by: Nils-ChristianIseke <nilsmailiseke@gmail.com>
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
Anything further blocking? Also just waiting on CI to build
|
I'm not sure I'm happy with it yet (we discussed about abstracting some parts to get rid of boilerplate, however i can think about that during another PR). You also mentioned that further validation should be done:
Should I take another closer look? So far I don't have enough context knowledge to know what range checks would be meaningful, for example. |
|
For this one, you can check if any parameter value is a The only other validity check needed is the one that is already in place for the rotation / reverse :-) |
Signed-off-by: Nils-ChristianIseke <nilsmailiseke@gmail.com>
971584c to
33bebad
Compare
|
I think we have the recipe down now! I think if you open the PR in this format, I can help on the parameter ranges and knock these out one at a time. Next on your list is MPPI - lets skip that one and circle back since that parameter design is very different and disrupts our flow. Pose Progress Checker is next up. Lets do all the nav2_controller progress checker / goal checker plugins next Pose Progress Checker
Simple Goal Checker:
Simple progress checker
Stopped goal checker
|
* 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 5377b65. 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 8a7ca39. 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 e6f500e ("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 ef1555e. 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> * Run ament_uncrustify to remove linting issues Signed-off-by: coderwyvern <saudintantrimain@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: coderwyvern <saudintantrimain@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: suchetanrs <79915569+suchetanrs@users.noreply.github.com> 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>
* 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>
* 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>
* 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 * 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> * Precompute yaw trigonometric values in smac planner (#5109) Signed-off-by: mini-1235 <mauricepurnawan@gmail.com> * removing the start navigation message in the paused state from rviz buttons (#5137) Signed-off-by: Pradheep <padhupradheep@gmail.com> * 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> * Prevent MPPI controller from resetting speed limits upon goal execution. (#5165) Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com> * Fixing docking server when already docked at the requeste ddock (#5171) Signed-off-by: Steve Macenski <stevenmacenski@gmail.com> * Adding parameter util to node utils (#5154) * Adding declare_or_get_param util to node utils Signed-off-by: Marco Bassa <marco.bassa@idealworks.com> * Adding test for declare_or_get_param util Signed-off-by: Marco Bassa <marco.bassa@idealworks.com> * Adding declare_or_get_parameter function by type, using explicit variable names, disabling param warnings by default Signed-off-by: Marco Bassa <marco.bassa@idealworks.com> * Update nav2_util/test/test_node_utils.cpp Signed-off-by: Steve Macenski <stevenmacenski@gmail.com> * Fixing codecove test Signed-off-by: Marco Bassa <marco.bassa@idealworks.com> * Catching possible exception in declare_or_get_by_type Signed-off-by: Marco Bassa <marco.bassa@idealworks.com> * Templating return type of declare parameter by value Signed-off-by: Marco Bassa <marco.bassa@idealworks.com> --------- Signed-off-by: Marco Bassa <marco.bassa@idealworks.com> Signed-off-by: Steve Macenski <stevenmacenski@gmail.com> Co-authored-by: Steve Macenski <stevenmacenski@gmail.com> * added config for laserscan in lb-sim (#5174) * added config for laserscan in lb-sim Signed-off-by: RamanaBotta <ramanab@bosonmotors.com> * fixing ament_flake8 errors Signed-off-by: RamanaBotta <ramanab@bosonmotors.com> * review: use_inf is default:true and added parameters on readme #4992 Signed-off-by: RamanaBotta <ramanab@bosonmotors.com> * refactor: meaningfull value for scan_angle_increment Signed-off-by: RamanaBotta <ramanab@bosonmotors.com> --------- Signed-off-by: RamanaBotta <ramanab@bosonmotors.com> Co-authored-by: RamanaBotta <ramanab@bosonmotors.com> * Publish planned footprints after smoothing (#5155) * Publish planned footprints after smoothing Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com> * Revert "Publish planned footprints after smoothing" This reverts commit c9b349a. * Add smoothed footprints publishing Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com> * fix formatting Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com> * Fix indentation for publisher creation in SmacPlannerHybrid and SmacPlannerLattice Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com> * address PR comments Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com> * fixes Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com> * fix build error Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com> --------- Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com> * fixing deprecation warning (#5182) Signed-off-by: Steve Macenski <stevenmacenski@gmail.com> * Adding missing dep to loopback sim (#5204) * Adding missing dep Signed-off-by: Steve Macenski <stevenmacenski@gmail.com> * typo Signed-off-by: Steve Macenski <stevenmacenski@gmail.com> * updating fix Signed-off-by: Steve Macenski <stevenmacenski@gmail.com> --------- Signed-off-by: Steve Macenski <stevenmacenski@gmail.com> * Adding parameter warn_when_defaulting_parameters to control default parameter warnings (#5189) * Adding a parameter warn_when_defaulting_parameters to control default parameter warnings instead of using a flag Signed-off-by: Marco Bassa <marco.bassa@idealworks.com> * Adding parameter strict_param_loading for optionally throwing an exception if parameter overrides are missing Signed-off-by: Marco Bassa <marco.bassa@idealworks.com> * Using default false declaration instead of declare_or_get in param util Signed-off-by: Marco Bassa <marco.bassa@idealworks.com> --------- Signed-off-by: Marco Bassa <marco.bassa@idealworks.com> * bumping to 1.3.7 for release Signed-off-by: Steve Macenski <stevenmacenski@gmail.com> --------- Signed-off-by: Nils-ChristianIseke <nilsmailiseke@gmail.com> Signed-off-by: Guillaume Doisy <guillaume@dexory.com> Signed-off-by: Vignesh T <vignesh.t@kabam.ai> Signed-off-by: mini-1235 <mauricepurnawan@gmail.com> Signed-off-by: Pradheep <padhupradheep@gmail.com> Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com> Signed-off-by: Tony Najjar <t03578624@gmail.com> Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com> Signed-off-by: Steve Macenski <stevenmacenski@gmail.com> Signed-off-by: Marco Bassa <marco.bassa@idealworks.com> Signed-off-by: RamanaBotta <ramanab@bosonmotors.com> Co-authored-by: Nils-Christian Iseke <48475933+Nils-ChristianIseke@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: Sandeep Dutta <quark01@gmail.com> Co-authored-by: Vignesh T <vignesh.t@kabam.ai> Co-authored-by: mini-1235 <mauricepurnawan@gmail.com> Co-authored-by: Pradheep Krishna <padhupradheep@gmail.com> Co-authored-by: Tony Najjar <tony.najjar.1997@gmail.com> Co-authored-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com> Co-authored-by: Marco Bassa <101661130+MarcoMatteoBassa@users.noreply.github.com> Co-authored-by: Raman <52356167+RamanRobotics@users.noreply.github.com> Co-authored-by: RamanaBotta <ramanab@bosonmotors.com>
* 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> Signed-off-by: Sakshay Mahna <sakshum19@gmail.com>
|
We just updated our nav2 after a while on the same version, and it looks like this PR is causing some issues for us. Is there some reason that a check for double's not being negative was added? We have had negative values in our param files for a long time, was there some change to how we are supposed to handle the yaml files that we missed? |
|
@Nianzu what value? I thought we checked and made sure to call out any negatives, but if we missed one or more, please let us know |
|
Sorry for the delay. I'm still trying to understand whats happening. It seems that this change is somehow applying outside of where it should. Our nav2_params.yaml file is affected, and we're seeing an error and then a crash anytime there is a negative value assigned to a double parameter. I'm wondering if the issue isn't in this PR, but in another later PR that causes this to apply to a wider scope than it should? Or is the parameter_handler.cpp here used elsewhere? |
|
We checked out https://github.com/ros-navigation/navigation2/releases/tag/1.3.6 and that seemed to resolve the problem for us, but I haven't gone through the process of checking each release since to see if it was in fact a later PR that brought up this issue. |
|
Maybe this is something I should open a separate ticket for? |
|
To make sure I understand, you're saying a newer release fixed your issue? Then I think I know what's happening here and that was fully resolved - just use the newer release. I could dig through and find the specific patch for you, but we did find a couple of bugs with this initial PR that we resolved in the following weeks of its merge |
|
Sorry for the lack of clarity, that might be the case, but so far I just tested the release right before this PR and that worked. Best I can tell, whatever is in the package manager right now is still causing this problem. I will try the latest release tag and report back whether we're still seeing the problem. |
* Dynamic param patterns (ros-navigation#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 (ros-navigation#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 (ros-navigation#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 ros-navigation#5087 (ros-navigation#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 * Update map_io library to use Eigen method for faster map loading (ros-navigation#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> * Precompute yaw trigonometric values in smac planner (ros-navigation#5109) Signed-off-by: mini-1235 <mauricepurnawan@gmail.com> * removing the start navigation message in the paused state from rviz buttons (ros-navigation#5137) Signed-off-by: Pradheep <padhupradheep@gmail.com> * Show error if inflation radius is smaller than circumscribed radius (ros-navigation#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> * Prevent MPPI controller from resetting speed limits upon goal execution. (ros-navigation#5165) Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com> * Fixing docking server when already docked at the requeste ddock (ros-navigation#5171) Signed-off-by: Steve Macenski <stevenmacenski@gmail.com> * Adding parameter util to node utils (ros-navigation#5154) * Adding declare_or_get_param util to node utils Signed-off-by: Marco Bassa <marco.bassa@idealworks.com> * Adding test for declare_or_get_param util Signed-off-by: Marco Bassa <marco.bassa@idealworks.com> * Adding declare_or_get_parameter function by type, using explicit variable names, disabling param warnings by default Signed-off-by: Marco Bassa <marco.bassa@idealworks.com> * Update nav2_util/test/test_node_utils.cpp Signed-off-by: Steve Macenski <stevenmacenski@gmail.com> * Fixing codecove test Signed-off-by: Marco Bassa <marco.bassa@idealworks.com> * Catching possible exception in declare_or_get_by_type Signed-off-by: Marco Bassa <marco.bassa@idealworks.com> * Templating return type of declare parameter by value Signed-off-by: Marco Bassa <marco.bassa@idealworks.com> --------- Signed-off-by: Marco Bassa <marco.bassa@idealworks.com> Signed-off-by: Steve Macenski <stevenmacenski@gmail.com> Co-authored-by: Steve Macenski <stevenmacenski@gmail.com> * added config for laserscan in lb-sim (ros-navigation#5174) * added config for laserscan in lb-sim Signed-off-by: RamanaBotta <ramanab@bosonmotors.com> * fixing ament_flake8 errors Signed-off-by: RamanaBotta <ramanab@bosonmotors.com> * review: use_inf is default:true and added parameters on readme ros-navigation#4992 Signed-off-by: RamanaBotta <ramanab@bosonmotors.com> * refactor: meaningfull value for scan_angle_increment Signed-off-by: RamanaBotta <ramanab@bosonmotors.com> --------- Signed-off-by: RamanaBotta <ramanab@bosonmotors.com> Co-authored-by: RamanaBotta <ramanab@bosonmotors.com> * Publish planned footprints after smoothing (ros-navigation#5155) * Publish planned footprints after smoothing Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com> * Revert "Publish planned footprints after smoothing" This reverts commit c9b349a. * Add smoothed footprints publishing Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com> * fix formatting Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com> * Fix indentation for publisher creation in SmacPlannerHybrid and SmacPlannerLattice Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com> * address PR comments Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com> * fixes Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com> * fix build error Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com> --------- Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com> * fixing deprecation warning (ros-navigation#5182) Signed-off-by: Steve Macenski <stevenmacenski@gmail.com> * Adding missing dep to loopback sim (ros-navigation#5204) * Adding missing dep Signed-off-by: Steve Macenski <stevenmacenski@gmail.com> * typo Signed-off-by: Steve Macenski <stevenmacenski@gmail.com> * updating fix Signed-off-by: Steve Macenski <stevenmacenski@gmail.com> --------- Signed-off-by: Steve Macenski <stevenmacenski@gmail.com> * Adding parameter warn_when_defaulting_parameters to control default parameter warnings (ros-navigation#5189) * Adding a parameter warn_when_defaulting_parameters to control default parameter warnings instead of using a flag Signed-off-by: Marco Bassa <marco.bassa@idealworks.com> * Adding parameter strict_param_loading for optionally throwing an exception if parameter overrides are missing Signed-off-by: Marco Bassa <marco.bassa@idealworks.com> * Using default false declaration instead of declare_or_get in param util Signed-off-by: Marco Bassa <marco.bassa@idealworks.com> --------- Signed-off-by: Marco Bassa <marco.bassa@idealworks.com> * bumping to 1.3.7 for release Signed-off-by: Steve Macenski <stevenmacenski@gmail.com> --------- Signed-off-by: Nils-ChristianIseke <nilsmailiseke@gmail.com> Signed-off-by: Guillaume Doisy <guillaume@dexory.com> Signed-off-by: Vignesh T <vignesh.t@kabam.ai> Signed-off-by: mini-1235 <mauricepurnawan@gmail.com> Signed-off-by: Pradheep <padhupradheep@gmail.com> Signed-off-by: Tony Najjar <tony.najjar.1997@gmail.com> Signed-off-by: Tony Najjar <t03578624@gmail.com> Signed-off-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com> Signed-off-by: Steve Macenski <stevenmacenski@gmail.com> Signed-off-by: Marco Bassa <marco.bassa@idealworks.com> Signed-off-by: RamanaBotta <ramanab@bosonmotors.com> Co-authored-by: Nils-Christian Iseke <48475933+Nils-ChristianIseke@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: Sandeep Dutta <quark01@gmail.com> Co-authored-by: Vignesh T <vignesh.t@kabam.ai> Co-authored-by: mini-1235 <mauricepurnawan@gmail.com> Co-authored-by: Pradheep Krishna <padhupradheep@gmail.com> Co-authored-by: Tony Najjar <tony.najjar.1997@gmail.com> Co-authored-by: Leander Stephen D'Souza <leanderdsouza1234@gmail.com> Co-authored-by: Marco Bassa <101661130+MarcoMatteoBassa@users.noreply.github.com> Co-authored-by: Raman <52356167+RamanRobotics@users.noreply.github.com> Co-authored-by: RamanaBotta <ramanab@bosonmotors.com>
Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>
* Revert ros-navigation#4971 in Jazzy Signed-off-by: mini-1235 <mauricepurnawan@gmail.com> * Add Signed-off-by: mini-1235 <mauricepurnawan@gmail.com> --------- Signed-off-by: mini-1235 <mauricepurnawan@gmail.com>
Basic Info
Description of contribution in a few bullet points
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:
@SteveMacenski I hope I understood the ticket correctly. I will continue to work on the rest of the codebase if these changes are the expected ones :).