Sonar sensor, now is working correctly

good