Add doors on hallways, including ability to open/close them

[sea-bass]

This will enrich the modeling language and action space of PyRoboSim with the following:

• Ability to add doors to hallways
• Ability for robots to open/close the doors
• Adding a collision polygon when doors are closed to make planning fail