void constructor(void)
{
task_CommStart.put(true);
//Wait till comm task is done initializing
while(CommReady.get() == false) {NNxt::sleep(50);}
//Get nav system ready
task_NavStart.put(true);
//Wait until initializaiton of slave is complete
while(MsgReady2Get.get() == false) {NNxt::sleep(50);}
//Make sure we recieved the init done message
if (ShareMsgID.get() == (U8) MessageClass::idInitDone)
{
Display.cursor(0,MIND_LINE);
Display.putf("s\n", "MasterMind Ready");
Display.disp();
}
//Otherwise throw an error
else
{
mSpeak.playTone(500,1000,20);
Display.cursor(0,MIND_LINE);
Display.putf("s\n", "ERROR!!!");
Display.cursor(0,DEBUG);
Display.putf("d\n", ShareMsgID.get(),0);
Display.disp();
NNxt::sleep(10000);
}
task_LFStart.put(true);
}