It compiles and runs.

Need to test with data from kinect or softkinetic.