Consider removing geometry object wrappers in favor of dispatching on underlying geometry type

[sea-bass]

See https://github.com/open-planning/roboplan-ros/pull/30/changes#r2902232547 -- the geometry type can be extracted from a pinocchio::GeometryObject and dispatched accordingly.

Thanks @eholum