Working pathfinding for 1 man

Reversing the collision grid: we define the walkable zone, not the
collision ones.
Work with 2 men