Wrote kinfu color, but it's super slow so we won't use it. Also working on making the cylinder detector see the pointclouds we're giving it.
Kinfu pretty good.