Refactored code more. Now the cluster extraction code is essentially ready to be integrated into kinfu (minus the bounding box publishing).
I believe I've got the gaussian publishing working correctly. Still have to clean up debugging code.
Managed to screw things up - now nothing's publishing properly.
Got everything working again.
Occluded region finder is ready to be integrated into kinfu.