Add Boost.Geometry support

[adamlm]

Motion planning inherently relies on geometry to function properly. The library is designed to be agnostic to the geometric types, but Boost.Geometry is commonly used. It would be good to have built-in support for that library while still allowing users to bring their own types.