wow, looks cool! with the direct drawing on the LCD
but try a optical sensor, will give you more precision on different surfaces and a sharper edge compared to the sonar.
see my 3d scanner(3D Scan Arduino) it uses a GP2Y0A02YK to get quite nice results