Sonar GPIO working