[algorithm] Enable the addition of a second geometry for puncture and insertion

[th-skam]

This comes after #56
The algorithm should be able to perform a puncture of a second layer (or bump onto a rigid impermeable object). Insertion must be able to continue inside that layer as well.