Add unit tests for Path

Includes tests for all four derived path cases, and a test for waypoints in a self-crossing snap-to-grid path. The
latter case used to include extraneous waypoints.