Arduino mega 2560 with cheap sonar HC-SR04 with auto calibration function