Add test case for Pose2D.to3DPose

kylecorry31 · kylecorry31 · commit 8df74616a4cb · 2017-02-26T12:23:36.000-05:00
diff --git a/src/test/java/com/kylecorry/geometry/Examples.java b/src/test/java/com/kylecorry/geometry/Examples.java
@@ -81,6 +81,8 @@ public void testPose2D() {
         assertEquals(1, pose2D.x, 0);
         assertEquals(2, pose2D.y, 0);
         assertEquals(Math.PI / 2, pose2D.theta, 0);
+
+        assertEquals(new Pose(new Point(1, 2, 0), new Quaternion(Math.PI / 2, Vector3.k)), pose2D.to3DPose());
     }
 
     @Test

Original file line number	Diff line number	Diff line change
`@@ -81,6 +81,8 @@ public void testPose2D() {`
`81`	`81`	`assertEquals(1, pose2D.x, 0);`
`82`	`82`	`assertEquals(2, pose2D.y, 0);`
`83`	`83`	`assertEquals(Math.PI / 2, pose2D.theta, 0);`
	`84`	`+`
	`85`	`+ assertEquals(new Pose(new Point(1, 2, 0), new Quaternion(Math.PI / 2, Vector3.k)), pose2D.to3DPose());`
`84`	`86`	`}`
`85`	`87`
`86`	`88`	`@Test`