Move angle functions to a library.
Store resolution within primitives.
Start working on Dubins path metric.