removed PRINT_GPIO and fixed sonar_gpio to have an pin high timeout