add real_dist and plane_angle to scanForPlanes