mscf = new MapStepCostFunction(aMap);
}
@Test
public void testCosts() {
Assert.assertEquals(5.0, mscf.c("A", new MoveToAction("B"), "B"), 0.001);
Assert.assertEquals(6.0, mscf.c("A", new MoveToAction("C"), "C"), 0.001);
Assert.assertEquals(4.0, mscf.c("B", new MoveToAction("C"), "C"), 0.001);
Assert.assertEquals(7.0, mscf.c("C", new MoveToAction("D"), "D"), 0.001);
Assert.assertEquals(14.0, mscf.c("B", new MoveToAction("E"), "E"),
0.001);
//
Assert.assertEquals(5.0, mscf.c("B", new MoveToAction("A"), "A"), 0.001);
Assert.assertEquals(6.0, mscf.c("C", new MoveToAction("A"), "A"), 0.001);
Assert.assertEquals(4.0, mscf.c("C", new MoveToAction("B"), "B"), 0.001);
Assert.assertEquals(7.0, mscf.c("D", new MoveToAction("C"), "C"), 0.001);
//
Assert.assertEquals(1.0, mscf.c("X", new MoveToAction("Z"), "Z"), 0.001);
Assert.assertEquals(1.0, mscf.c("A", new MoveToAction("Z"), "Z"), 0.001);
Assert.assertEquals(1.0, mscf.c("A", new MoveToAction("D"), "D"), 0.001);
Assert.assertEquals(1.0, mscf.c("A", new MoveToAction("B"), "E"), 0.001);
}