Motion Primitive Arc Closest Point and Unit Tests