Fix bug in sense sonar