WIP: Continuoius collision pipeline implementation.

Add intersection methods. Tidy and clean a bit, comment
NormalProjectios.h. Wrapping up integration.

Issue #3
Issue #4