Open royito55 opened 1 year ago
Just an update, this error happens when the path in the topic /fleet_states for the robot doing the task is empty.
Why would it be empty if the robot has not finished the path? I've set the fleet adapter parameters to match the average nominal speed of the robot but there is still a large mismatch that occurs randomly between the robot state (purple circle) and its planned path (yellow circle)
In the video below you can see that the error appears for the robot barista_1, exactly when the schedule starts planning the robot trajectory. Why would it say the path is empty when I can visualize it and the robot hasn't even started moving? It's as if the system expects for the robot to be in the second location immediately.
Discussed in https://github.com/open-rmf/rmf/discussions/232