Improvements to surf plane (with errors)

Segmentation fault! Needs correction still.
Error correction and new criteria

Corrected segmentation error, added new neighbor criteria