simPilot.setLeftMotor(0, new NxtMotorStub(0));
simPilot.setRightMotor(2, new NxtMotorStub(2));
simPilot.setSimPos(new SimPosition(0, 0, 0));
Motor.A.stop();
Motor.C.stop();
ZPilot zPilot = new ZPilot(5.6f, 11.6f, Motor.A, Motor.C);
assertTrue(simPilot.getSimPos().equals(new SimPosition(0, 0, 0)));
zPilot.travel(10);
assertEquals(10*ArenaGui.FACTOR_PX_CM, simPilot.getPosX(), 0.1*10*ArenaGui.FACTOR_PX_CM);
zPilot.travel(30);
assertEquals(40*ArenaGui.FACTOR_PX_CM, simPilot.getPosX(), 0.2*40*ArenaGui.FACTOR_PX_CM);
}