Provides a library of various geometry utility functions for use in search-based motion planning