A* Pathfinding, still buggy

Known problems:
  - Bios walk through walls diagonally, like slippery bishops
  - They don't head to a sensible location when there is no way through