Fixed wall bug AStar

Bug was it could move diagonally through walls which should not be
possible, ugly fix but works, will see if it can be changed to something
more sophisticated