import console;

msg301_test1 = 0;
msg301_test2 = 0;
msg301_test3 = 0;
msg301_test4 = 0;
msg301_test5 = 0;
msg301_FanState = 0;
msg301_HeatState = 0;


getbitdata = function(byte,startbit,len){
	return ((byte>>startbit) & ((1<<len) - 1)); 
}

import win.timer;
MsgProTable = {0x301,0x401,0x402,0x403,0x404,0x405,0x406};
MsgProTimer = win.timer(,100);
MsgProTimer.onTimer = function(){
	for(k,v in MsgProTable){
		var ret = CT_GetRxMsg(v);
		if(ret != null){
			MsgPro(v,ret);
		}
	}
}
var motor_state = {};
motor_state["status"] = 0;
motor_state["hallio"] = 0;
motor_state["loc"] = 0;
motor_state["stop1"] = 0;
motor_state["stop2"] = 0;
msgDebug = {};
for(i=1;4;1){
	msgDebug[i] = {};
	msgDebug[i]["status"]  = 0;// = motor_state;
	msgDebug[i]["hallio"]  = 0;
	msgDebug[i]["loc"]  = 0;
	msgDebug[i]["stop1"]  = 0;
	msgDebug[i]["stop2"]  = 0;
}

testdata = {};
	
MsgPro = function(id,data){
	if(data == null){
		return ; 
	}
	select(id) {
		case 0x301 {
			msg301_FanState = getbitdata(data[3],0,2);
			msg301_HeatState = getbitdata(data[3],2,2);
			msg301_test1 = data[4];
			msg301_test2 = data[5];
			msg301_test3 = data[6];
			msg301_test4 = data[7];
			msg301_test5 = data[8];
		}
		case 0x401{
			msgDebug[1]["status"] = getbitdata(data[2],0,2);
			msgDebug[1]["hallio"] = getbitdata(data[2],2,1);
			msgDebug[1]["loc"] = data[3] + (data[4]<<8);
			msgDebug[1]["stop1"] = data[5] + (data[6]<<8);
			msgDebug[1]["stop2"] = data[7] + (data[8]<<8);
			
		}
		case 0x402{
			msgDebug[2]["status"] = getbitdata(data[2],0,2);
			msgDebug[2]["hallio"] = getbitdata(data[2],2,1);
			msgDebug[2]["loc"] = data[3] + (data[4]<<8);
			msgDebug[2]["stop1"] = data[5] + (data[6]<<8);
			msgDebug[2]["stop2"] = data[7] + (data[8]<<8);
			
		}
		case 0x403{
			msgDebug[3]["status"] = getbitdata(data[2],0,2);
			msgDebug[3]["hallio"] = getbitdata(data[2],2,1);
			msgDebug[3]["loc"] = data[3] + (data[4]<<8);
			msgDebug[3]["stop1"] = data[5] + (data[6]<<8);
			msgDebug[3]["stop2"] = data[7] + (data[8]<<8);
			
		}
		case 0x404{
			msgDebug[4]["status"] = getbitdata(data[2],0,2);
			msgDebug[4]["hallio"] = getbitdata(data[2],2,1);
			msgDebug[4]["loc"] = data[3] + (data[4]<<8);
			msgDebug[4]["stop1"] = data[5] + (data[6]<<8);
			msgDebug[4]["stop2"] = data[7] + (data[8]<<8);
			
		}
		else {
		}
	}
}