From dcfe56dbb9e4ab3d0af45809801ee5876eea2ffc Mon Sep 17 00:00:00 2001
From: Oscar Lorentzon <oscar.lorentzon@gmail.com>
Date: Fri, 11 Dec 2015 15:32:04 +0100
Subject: [PATCH] Potential edge motion unit tests.

---
 spec/graph/edge/EdgeCalculator.spec.ts | 103 +++++++++++++++++++++++++
 1 file changed, 103 insertions(+)

diff --git a/spec/graph/edge/EdgeCalculator.spec.ts b/spec/graph/edge/EdgeCalculator.spec.ts
index 893c7951..06d9f77f 100644
--- a/spec/graph/edge/EdgeCalculator.spec.ts
+++ b/spec/graph/edge/EdgeCalculator.spec.ts
@@ -61,6 +61,8 @@ describe("EdgeCalculator", () => {
 });
 
 describe("EdgeCalculator.getPotentialEdges", () => {
+    let epsilon: number = 1e-8;
+
     let edgeCalculator: EdgeCalculator;
     let spatial: Spatial;
 
@@ -154,4 +156,105 @@ describe("EdgeCalculator.getPotentialEdges", () => {
         expect(potentialEdge.apiNavImIm.key).toBe(edgeKey);
         expect(potentialEdge.distance).toBe(5);
     });
+
+
+    it("should return a potential edge with correct motion change", () => {
+        let key: string = "key";
+        let edgeKey: string = "edgeKey";
+
+        let sequence: Sequence = createSequence("skey", [key, edgeKey]);
+
+        let node: Node = createNode(key, sequence, [0, -Math.PI / 2, 0], [-10, -10, -5])
+        let edgeNode: Node = createNode(edgeKey, sequence, [0, -Math.PI / 2, 0], [-5, -5, -5]);
+
+        let potentialEdges: IPotentialEdge[] =
+            edgeCalculator.getPotentialEdges(node, [edgeNode], []);
+
+        expect(potentialEdges.length).toBe(1);
+
+        let potentialEdge: IPotentialEdge = potentialEdges[0];
+
+        expect(potentialEdge.apiNavImIm.key).toBe(edgeKey);
+        expect(potentialEdge.motionChange).toBeCloseTo(Math.PI / 4, epsilon);
+    });
+
+    it("should return a potential edge with correct motion change", () => {
+        let key: string = "key";
+        let edgeKey: string = "edgeKey";
+
+        let sequence: Sequence = createSequence("skey", [key, edgeKey]);
+
+        let node: Node = createNode(key, sequence, [Math.PI / 2, 0, 0], [10, -10, -5])
+        let edgeNode: Node = createNode(edgeKey, sequence, [Math.PI / 2, 0, 0], [15, -5, -5]);
+
+        let potentialEdges: IPotentialEdge[] =
+            edgeCalculator.getPotentialEdges(node, [edgeNode], []);
+
+        expect(potentialEdges.length).toBe(1);
+
+        let potentialEdge: IPotentialEdge = potentialEdges[0];
+
+        expect(potentialEdge.apiNavImIm.key).toBe(edgeKey);
+        expect(potentialEdge.motionChange).toBeCloseTo(-Math.PI / 4, epsilon);
+    });
+
+    it("should return a potential edge with correct motion change", () => {
+        let key: string = "key";
+        let edgeKey: string = "edgeKey";
+
+        let sequence: Sequence = createSequence("skey", [key, edgeKey]);
+
+        let node: Node = createNode(key, sequence, [Math.PI / 2, 0, 0], [0, 0, 0])
+        let edgeNode: Node = createNode(edgeKey, sequence, [Math.PI / 2, 0, 0], [0, -10, 0]);
+
+        let potentialEdges: IPotentialEdge[] =
+            edgeCalculator.getPotentialEdges(node, [edgeNode], []);
+
+        expect(potentialEdges.length).toBe(1);
+
+        let potentialEdge: IPotentialEdge = potentialEdges[0];
+
+        expect(potentialEdge.apiNavImIm.key).toBe(edgeKey);
+        expect(Math.abs(potentialEdge.motionChange)).toBeCloseTo(Math.PI, epsilon);
+    });
+
+    it("should return a potential edge with correct vertical motion", () => {
+        let key: string = "key";
+        let edgeKey: string = "edgeKey";
+
+        let sequence: Sequence = createSequence("skey", [key, edgeKey]);
+
+        let node: Node = createNode(key, sequence, [Math.PI / 2, 0, 0], [0, 0, 0])
+        let edgeNode: Node = createNode(edgeKey, sequence, [Math.PI / 2, 0, 0], [3, 4, 5]);
+
+        let potentialEdges: IPotentialEdge[] =
+            edgeCalculator.getPotentialEdges(node, [edgeNode], []);
+
+        expect(potentialEdges.length).toBe(1);
+
+        let potentialEdge: IPotentialEdge = potentialEdges[0];
+
+        expect(potentialEdge.apiNavImIm.key).toBe(edgeKey);
+        expect(potentialEdge.verticalMotion).toBeCloseTo(Math.PI / 4, epsilon);
+    });
+
+    it("should return a potential edge with correct vertical motion", () => {
+        let key: string = "key";
+        let edgeKey: string = "edgeKey";
+
+        let sequence: Sequence = createSequence("skey", [key, edgeKey]);
+
+        let node: Node = createNode(key, sequence, [Math.PI / 2, 0, 0], [0, 0, 0])
+        let edgeNode: Node = createNode(edgeKey, sequence, [Math.PI / 2, 0, 0], [-3, -4, -5]);
+
+        let potentialEdges: IPotentialEdge[] =
+            edgeCalculator.getPotentialEdges(node, [edgeNode], []);
+
+        expect(potentialEdges.length).toBe(1);
+
+        let potentialEdge: IPotentialEdge = potentialEdges[0];
+
+        expect(potentialEdge.apiNavImIm.key).toBe(edgeKey);
+        expect(potentialEdge.verticalMotion).toBeCloseTo(-Math.PI / 4, epsilon);
+    });
 });