/** Default constructor, initializes the motors and sensors */
public MazeSolver() {
// Set up motors and sensors
myPilot = new DifferentialPilot(wheelDiam, axleLength, Motor.B, Motor.A, true);
myFrontSensor = new LightSensor(SensorPort.S1);
myRightSensor = new LightSensor(SensorPort.S2);
myCompass = new CompassSensor(SensorPort.S3);
// Set rotate speed
myPilot.setRotateSpeed(rotateSpeed);
myPilot.setAcceleration(70);
// Calibrate
doCalibration();
}
