added distance measure from robot to nearest object. Currently only the nearest line. This is buggy currently and needs to be debuged.
some debugging in progress
debugging distance calculations
debugging
Fixed distance to lines bug.
added function to map for local distances
added circles to the distance calculation
added local mapping to each robot. can also print it to the screen.