if(valid) analyzeUrmData(cmdrd);
// else SerialPort.println("Invalid feedback"); //Get an invalid error co
mmand
}
}
void analyzeUrmData(byte cmd[]){
byte sumCheck = 0;
for(int h = 0;h < 7; h ++) sumCheck += cmd[h];
if(sumCheck == cmd[7] && cmd[3] == 2 && cmd[4] == 2){
byte id = cmd[2] - startAddr;
urmData[id] = cmd[5] * 256 + cmd[6];
// SerialPort.print(id);
// SerialPort.print(":");
// SerialPort.println(urmData[id]);
}
else if(cmd[3] == 2 && cmd[4] == 2){
SerialPort.print("Sum error");
}
}
Powered By DFRobot © 2008-2017
