Reordered arguments in Assert.areEqual calls

Leads to more accurate error messages when failing.
Added pathfinder class