Hallo!
Die DS hängt am Pin 20 / 21 und kriegst lauter 128.128 ?
Einfach 20/21 tauschen....sollte eigentlich keine Probleme machen.
Beim Sensor solltest mal die Ultrasonic oder die NewPing Librarys versuchen.
Damit klappts einigermassen genau.
Zum Testen gibts das:
http://forum.arduino.cc/index.php?topic=50203.0
....würde ein Cooles Projekt abgeben, am Mega....
mfg Martin