It was reported by @cwrx777 that when a replan happens while a robot is passing through door, the code that ensures the door is held open may accidentally open doors on other maps that are vertically aligned with the one that needs to be held open. This PR fixes the issue.
I tested this by running the hotel world and sending the robot through a door on L2 that has a matching door above it on L3. I force a replan to happen just before the robot attempts to go through the door. Before this PR, both doors would open after the replan. After this PR only the door on L2 is opened.
It was reported by @cwrx777 that when a replan happens while a robot is passing through door, the code that ensures the door is held open may accidentally open doors on other maps that are vertically aligned with the one that needs to be held open. This PR fixes the issue.
I tested this by running the hotel world and sending the robot through a door on L2 that has a matching door above it on L3. I force a replan to happen just before the robot attempts to go through the door. Before this PR, both doors would open after the replan. After this PR only the door on L2 is opened.