package lejos.test;
import junit.framework.TestCase;
import lejos.navigation.Pilot;
import lejos.nxt.Motor;
import lejos.stub.MotorStub;
import de.nordakademie.lejos.simulator.PilotPositionTracker;
public class TestPositionTracker extends TestCase {
PilotPositionTracker tracker;
private Pilot p;
protected void setUp() throws Exception {
tracker = new PilotPositionTracker(5f,10f,0,2);
p=new Pilot(5f,10f,Motor.A,Motor.C);
}
protected void tearDown() throws Exception {
Motor.A.stop();
Motor.C.stop();
Motor.A.resetTachoCount();
Motor.C.resetTachoCount();
MotorStub.off();
}
public void testTravel(){
p.setSpeed(100);
p.travel(10);
assertEquals(0,tracker.getPosition().y, 3);
assertEquals(100,tracker.getPosition().x, 5);
}
}