Working implementation of HW2.
And the map I tested it with.