public Contingency(Encoder left, Encoder right, NavigationManager navigation)
{
alarm = false;
monitor = new object();
this.left = left;
this.right = right;
this.navigation = navigation;
count = 0;
end = false;
th = new Thread(new ThreadStart(Run));
th.Start();
th2 = new Thread(new ThreadStart(Act));
th2.Start();
t = new Timer(new TimerCallback(decount), new object(), 0, 5000);
}
public void InitializeSystem()
{
debug = new OutputPort((Cpu.Pin)PortMap.debug, false);
debug.Write(true);
coder = new Coder();
Thread.Sleep(17000);
coder.Start();
Info("Initializing System...");
navigation = new NavigationManager();
Info("Initialized NavigationManager");
sensors = new SensorManager();
Info("Initialized SensorManager");
battery = new BatteryManager();
Info("Initialized BatteryManager");
currentMode = Mode.SearchingForWall;
sensorTimer = new Timer(new TimerCallback(sensorTimer_tick), new object(), 0, GlobalVal.transmissionPeriodSensor_ms);
positionTimer = new Timer(new TimerCallback(posTimer_Tick), new object(), 0, GlobalVal.transmissionPeriodPosition_ms);
batteryTimer = new Timer(new TimerCallback(batteryTimer_Tick), new object(), 0, GlobalVal.transmissionPeriodBattery_ms);
magTimer = new Timer(new TimerCallback(magnetometer_Tick), new object(), 0, GlobalVal.trasmissionPeriodMagnetometer_ms);
Info("Initialized Timers");
cancel = false;
debug.Write(false);
navigation.manualSpeed = GlobalVal.speed;
navigation.manualTurningSpeed = GlobalVal.turningSpeed;
Info("Ready");
}