support cylinder, box, https://code.ros.org/trac/ros-pkg/ticket/4276
rename Point->Triangle, use heuristic sphere vertices generation, add const
use references for point args