Wrote TestPath test.

Tests for LeastCostEstimate and AdjacentCost methods.