}
@Test
public void testSetSensorPositions(){
simPilot.setSimPos(new SimPosition(35, 10, 12));
LightSensorStub l = new LightSensorStub(simPilot.getSimPos());
simPilot.setLightSensor(0, l);
simPilot.setSensorPosition(); //DISTANCE_OF_SENSOR = 25
assertEquals((int)(simPilot.getPosX() + Math.cos(Math.toRadians(simPilot.getHeading()))*25), l.getPosX(), 0.4);
assertEquals((int)(simPilot.getPosY() + Math.sin(Math.toRadians(simPilot.getHeading()))*25), l.getPosY(), 0.4);
assertEquals(simPilot.getHeading(), l.getHeading());
}