|
@ -64,12 +64,11 @@ void ZCanBasicOrderModule::onRceivePacket(CanPacketRxBuffer* rxbuf, uint8_t* pac |
|
|
uint8_t ioid = cmdheader->data[0]; |
|
|
uint8_t ioid = cmdheader->data[0]; |
|
|
bool val = cmdheader->data[1]; |
|
|
bool val = cmdheader->data[1]; |
|
|
if (m_writefn && m_writefn(ioid, val)) { |
|
|
if (m_writefn && m_writefn(ioid, val)) { |
|
|
Cmdheader_t* txheader = (Cmdheader_t*)txbuff; |
|
|
|
|
|
memcpy(txheader, cmdheader, sizeof(Cmdheader_t)); |
|
|
|
|
|
txheader->packetType = kpt_ack; |
|
|
|
|
|
txheader->data[0] = cmdheader->data[0]; |
|
|
|
|
|
txheader->data[1] = cmdheader->data[1]; |
|
|
|
|
|
m_zcanReceiver->sendPacket(txbuff, sizeof(Cmdheader_t) + 2); |
|
|
|
|
|
|
|
|
uint8_t txbuff[2] = {0}; |
|
|
|
|
|
txbuff[0] = ioid; |
|
|
|
|
|
txbuff[1] = val; |
|
|
|
|
|
|
|
|
|
|
|
m_zcanReceiver->sendAck(cmdheader, txbuff, sizeof(txbuff)); |
|
|
return; |
|
|
return; |
|
|
} |
|
|
} |
|
|
} else if (cmdheader->cmdid == kcmd_readadc_raw && cmdheader->subcmdid == 0) { |
|
|
} else if (cmdheader->cmdid == kcmd_readadc_raw && cmdheader->subcmdid == 0) { |
|
|