Ultrasound distance measure. Drawing map (with some bug yet)