Added the testForward case for AutoMoveTo. This test also fails and the bug needs fixing.

Author: Corvin Bazgan

Robot2018/test/org/usfirst/frc/team199/Robot2018/AutoMoveToTest.java

@@ -112,4 +112,26 @@ void testForwardAndRight() {
 		assertEquals(12, AutoUtils.getX());
 		assertEquals(12, AutoUtils.getY());
 	}
+
+	@Test
+	void testForward() {
+		String[] args = {"(0,12)"};
+		
+		AutoUtils.setRot(0);
+		AutoUtils.setX(0);
+		AutoUtils.setY(0);
+		
+		PIDSource pidGyroSrc = mock(PIDSource.class);
+		when(pidGyroSrc.getPIDSourceType()).thenReturn(PIDSourceType.kDisplacement);
+		DrivetrainInterface dt = mock(DrivetrainInterface.class);
+		when(dt.getGyro()).thenReturn(pidGyroSrc);		
+		SmartDashboardInterface sd = mock(SmartDashboardInterface.class);
+		PIDSource pidMoveSrc = mock(PIDSource.class);
+		
+		AutoMoveTo testAMT = new AutoMoveTo(args, dt, sd, pidMoveSrc);
+		
+		assertEquals(0, AutoUtils.getRot());
+		assertEquals(0, AutoUtils.getX());
+		assertEquals(12, AutoUtils.getY());
+	}
 }