Have robots/world check that they're about to collide, error job

[Elucidation]

Right now collisions are detected but ignored besides a log message.
It'd be nice if when a robot tries to move to a next path point, if that next point is blocked (by a robot or wall etc.) then it won't go there, and it doesn't pop the future path and instead the robot manager realizes robot is in error, and then job error etc. where robot will then try to replan or fail or go home?

This will allow for testing by adding new obstacles or purposefully breaking a robot (wheels don't work as an example) and seeing how the system reacts.

This will probably cause pileups as many robots will be following each other without much space, should be interesting