Fix sonar read logic
Improve sonar readout to only trust in-band values