It compiles and runs.

Need to test with data from kinect or softkinetic.
Merge pull request #1 from jdddog/master

It compiles and runs.