This is how I gived in my homework

Bugs

• PathGenerator on a large (4x6 Map) I think enters an infinity loop (in the Unit test case looks like it)