Verbetering afstandsberekening (Include nu ook afstand tot muren)