Filter close points out of all pointclouds

[fnivek]

I have a quick fix in place. I still need to create a box representing the boat to remove all points from within.