added distance measure from robot to nearest object. Currently only the nearest line. This is buggy currently and needs to be debuged.