|
|
@ -118,14 +118,14 @@ HAL_StatusTypeDef ZCanCommnaderMaster::initializeFilter() { |
|
|
|
ZLOGI(TAG, "HAL_CAN_ConfigFilter filterID1 %08x", filterId >> 3); |
|
|
|
return HAL_Status; |
|
|
|
} |
|
|
|
int32_t ZCanCommnaderMaster::sendCmdAndReceiveBuf(int32_t cmdid, int32_t submoduleid, int32_t *param, size_t npara, uint8_t *ack, int32_t *rxsize, int overtime_ms) { |
|
|
|
int32_t ZCanCommnaderMaster::sendCmdAndReceiveBuf(int32_t cmdid, int32_t subModuleid, int32_t *param, size_t npara, uint8_t *ack, int32_t *rxsize, int overtime_ms) { |
|
|
|
zcr_cmd_header_t *cmdheader = (zcr_cmd_header_t *)txbuff; |
|
|
|
cmdheader->packetType = kptv2_cmd; |
|
|
|
cmdheader->packetindex = generateFreeIndex(); |
|
|
|
cmdheader->cmdmoduleid = MODULE_CMDID(cmdid); |
|
|
|
cmdheader->subcmdid = SUBCMDID(cmdid); |
|
|
|
cmdheader->submoduleid = submoduleid; |
|
|
|
// ZLOGI(TAG, "sendCmd %d %d %d %d", cmdheader->packetindex, cmdheader->cmdmoduleid, cmdheader->subcmdid, cmdheader->submoduleid);
|
|
|
|
cmdheader->cmdMainId = MODULE_CMDID(cmdid); |
|
|
|
cmdheader->cmdSubId = CMD_SUB_ID(cmdid); |
|
|
|
cmdheader->subModuleid = subModuleid; |
|
|
|
// ZLOGI(TAG, "sendCmd %d %d %d %d", cmdheader->packetindex, cmdheader->cmdMainId, cmdheader->cmdSubId, cmdheader->subModuleid);
|
|
|
|
int32_t *sendparam = (int32_t *)cmdheader->data; |
|
|
|
for (size_t i = 0; i < npara; i++) { |
|
|
|
sendparam[i] = param[i]; |
|
|
@ -166,14 +166,14 @@ int32_t ZCanCommnaderMaster::sendCmdAndReceiveBuf(int32_t cmdid, int32_t submodu |
|
|
|
return errocode; |
|
|
|
} |
|
|
|
|
|
|
|
int32_t ZCanCommnaderMaster::sendCmd(int32_t cmdid, int32_t submoduleid, int32_t *param, size_t npara, int32_t *ack, size_t nack, int overtime_ms) { |
|
|
|
int32_t ZCanCommnaderMaster::sendCmd(int32_t cmdid, int32_t subModuleid, int32_t *param, size_t npara, int32_t *ack, size_t nack, int overtime_ms) { |
|
|
|
zcr_cmd_header_t *cmdheader = (zcr_cmd_header_t *)txbuff; |
|
|
|
cmdheader->packetType = kptv2_cmd; |
|
|
|
cmdheader->packetindex = generateFreeIndex(); |
|
|
|
cmdheader->cmdmoduleid = MODULE_CMDID(cmdid); |
|
|
|
cmdheader->subcmdid = SUBCMDID(cmdid); |
|
|
|
cmdheader->submoduleid = submoduleid; |
|
|
|
// ZLOGI(TAG, "sendCmd %d %d %d %d", cmdheader->packetindex, cmdheader->cmdmoduleid, cmdheader->subcmdid, cmdheader->submoduleid);
|
|
|
|
cmdheader->cmdMainId = MODULE_CMDID(cmdid); |
|
|
|
cmdheader->cmdSubId = CMD_SUB_ID(cmdid); |
|
|
|
cmdheader->subModuleid = subModuleid; |
|
|
|
// ZLOGI(TAG, "sendCmd %d %d %d %d", cmdheader->packetindex, cmdheader->cmdMainId, cmdheader->cmdSubId, cmdheader->subModuleid);
|
|
|
|
int32_t *sendparam = (int32_t *)cmdheader->data; |
|
|
|
for (size_t i = 0; i < npara; i++) { |
|
|
|
sendparam[i] = param[i]; |
|
|
|