109 lines
2.3 KiB
Plaintext
109 lines
2.3 KiB
Plaintext
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 {
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|