Patched ROSARIA implementation for correct sonar readings