Plane vs Object Detection working

I haven't uploaded the dataset I used for testing this code. It's too big.
This was adapted from PCL's SAC model stuff. This is just working for
plane detection.

This keeps up when the ground plane is nicely visible by feeding the
previous known location into the next frame.