コード例 #1
0
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);
	
}