path following
added check whether point is inside walls