Added scale legend. Corrected SONAR point drawing