swri_geometry_util

Commonly used geometry routines, implemented in a ROS friendly package.