Y porque no usas la libreria disponible en lugar de tu código?
Arduino NewPing Library
Tiene ejemplos, pruébalos y luego nos cuentas si sigue mal o no.
Y porque no usas la libreria disponible en lugar de tu código?
Arduino NewPing Library
Tiene ejemplos, pruébalos y luego nos cuentas si sigue mal o no.