Added weighting for unknown cells and occupied cells and prevented walking inbetween diagonally adjacent solid cells.