open-rmf / rmf

Root repository for the RMF software
Apache License 2.0
223 stars 57 forks source link

Issue with ResponsiveWait Feature in Open RMF Fleet Management #429

Open osama-z-salah opened 4 months ago

osama-z-salah commented 4 months ago

Before proceeding, is there an existing issue or discussion for this?

Description

I am currently utilizing full_control RMF fleet adapter for my robotics project. My workflow involves sending the robot to a specific waypoint using the following command:

ros2 run rmf_demos_tasks dispatch_go_to_place -p my_parking -o -90

This command is intended to direct the robot to my predefined parking waypoint with an orientation of -90 degrees. The robot successfully reaches the destination with the correct heading. However, upon arrival, I encounter an issue where it receives two additional waypoints. I suspect these are generated by the ResponsiveWait feature. These waypoints have the same x and y coordinates as my intended destination but come with different yaw values. Consequently, this discrepancy results in the robot assuming a different heading from the one I specified, thus deviating from the desired orientation.

Could you please assist me in resolving this issue? I am looking for a way to either adjust the ResponsiveWait feature's behavior to prevent the generation of these additional waypoints or to ensure that any waypoints generated maintain the robot's orientation as specified in the dispatch command.

Thank you for your assistance.

arjo129 commented 4 months ago

Do you have a finishing task set? Perhaps you want to disable it in the fleet config.

You can disable responsive wait here: https://github.com/open-rmf/rmf_demos/blob/d6b8df19d01089b37a85466129a0e7101a965110/rmf_demos/config/office/tinyRobot_config.yaml#L38