Revert "fix for OS X"

This reverts commit 2272a34417428cd49376d9bc10543ae04f532528.
Added a dumb filter for the sonar array
Fixed some bugs in the sonar filter