updated function distance_to_wall
have not finished distance-to_goal function
Merge branch 'dash'