WIP: Add collision response classes to handle continuous collision.

Contact mapper and continuous penalty contact classes handle
contact response. Sistematic test of primitive collision check
is done by comparing input-output in the intersection methods
with corresponding ones in the SCCD.

Issue #3
Issue #4