Add cylinder detection
Add cylinder detection

- Add cylinder detection to callback
- Extract points from filtered cloud
- Calculate the avg of the points/color in the filtered cloud

Still have a lot to do, but it's a start.

zimmermegan/smarda,zimmermegan/smarda,zimmermegan/smarda,zimmermegan/smarda,zimmermegan/smarda,zimmermegan/smarda