Mejorar presision del HC-SR04

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.