Finalised simple coverage and added input checks.

Added checks for tether-obstacle intersection by fixing and modifying
the path-path intersection algorithm.