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
[for help] BT node Is_path_longer_on_approach doesn't work #4110
Comments
Your BT probably isn't being changed, did you verify that you are actually using the new BT or see any log errors? Please ask on Robotics Stack Exchange unless @padhupradheep has any insights to share |
Hey @kevinpretell I see that you are using a proximity length of 6m with a factor of 1.2 m. The length of the new plan does not seem to be (significantly) longer based on the video that you have posted. |
Okay, we need to re-open this issue I think. Just noticed that, Edit: we need to take care of it while update to BT 4. Just looked at source of the BT. For some reason, the documentation of BT.CPP does not reflect that in V3.8. |
Alright, in any case, it doesn't work @kevinpretell thanks for reporting. Sorry for overlooking it before, as you might know, we are very low in resource and try our best to support you as much as we can. I've also taken the opportunity to go one step ahead by fixing the issue. @SteveMacenski: could you please reopen the issue, before I can give in the fix? I still need to test it. Crux of the issue seems that the status of the node is set to IDLE. Last year, when I had implemented, the status ended up to success and went IDLE only when the entire BT was IDLE. This IDLE state was blocking the logic of the intended decorator going forward. I however have found a fix, that uses the goals of the old path and the new path, to avoid the blocking. |
I'm really looking forward to learning about your progress in the development process and how you've found a solution to this problem. Best wishes for your continued success and great efforts as you conclude this work.@padhupradheep |
I am also facing similar problem. I need a behaviour tree that doesn't replan and wait for the obstacle to clear infinitely. It only planes when the new goal is received. Please help. |
I also found this problem with ros2 humble, are you found a fix by modifing Thank you. |
Please give me few more days, I will do the fix.. Really sorry for the long delay... |
Resolved by the PR linked above! Thanks for the report @kevinpretell |
Bug report
I'm practicing on this nav2 simulation for outdoor navigation without problems.
https://navigation.ros.org/tutorials/docs/navigation2_with_gps.html
To manage obstacles I found this BT node which is very interesting, if the robot sees a dynamic obstacle it stops until it goes away.
https://navigation.ros.org/behavior_trees/trees/nav_to_pose_and_pause_near_goal_obstacle.html
I then replaced my default nav_to_pose.xml behavior with the one from the demo above by placing it in the config folder.
But nav2 seems to ignore the new beaviour xml by following its path without stopping at the obstacle.
I ask here because I saw that no one is talking around about this BT node.
Many thanks in advance
Operating System:
ROS2 Version:
DDS implementation:
Steps to reproduce issue
Replace the default bt: navigate_to_pose_w_replanning_and_recovery.xml
with the bt: navigate_to_pose_w_replanning_goal_patience_and_recovery.xml
PathLongerOnApproach setting:
<PathLongerOnApproach path="{path}" prox_len="6.0" length_factor="1.2">
start the gazebo simulation:
ros2 launch nav2_gps_waypoint_follower_demo gps_waypoint_follower.launch.py use_rviz:=True
From the gazebo I add an obstacle in front of the moving robot.
Expected behavior
the robot should stop and wait for the obstacle to go away before following the new path
Actual behavior
the robot does not stop when a longer path is recalculated waiting for the obstacle to go away, and takes the longer path
Additional information
Maybe I need to change something else in the Nav2 params file?
here is my bt navigator params:
here is my new default_nav_to_pose_bt_xml:
The text was updated successfully, but these errors were encountered: