Updated sonarPredict to handle optionalWalls
more robust localization