|
@ -112,7 +112,7 @@ void IflytopCanbusMaster::processRxPacket(zcr_cmd_header_t *frame, size_t len) { |
|
|
} |
|
|
} |
|
|
|
|
|
|
|
|
void IflytopCanbusMaster::updateChannelConfig() { //
|
|
|
void IflytopCanbusMaster::updateChannelConfig() { //
|
|
|
m_waveCan.setCanpPrameter(CANUSB_SPEED_500000, CANUSB_MODE_NORMAL, CANUSB_FRAME_STANDARD); |
|
|
|
|
|
|
|
|
m_waveCan.setCanpPrameter(CANUSB_SPEED_1000000, CANUSB_MODE_NORMAL, CANUSB_FRAME_STANDARD); |
|
|
} |
|
|
} |
|
|
void IflytopCanbusMaster::ping(int32_t device_id) { |
|
|
void IflytopCanbusMaster::ping(int32_t device_id) { |
|
|
int32_t param[4]; |
|
|
int32_t param[4]; |
|
@ -129,7 +129,7 @@ void IflytopCanbusMaster::readreg(int32_t device_id, int32_t regaddr, int32_t *v |
|
|
int32_t IflytopCanbusMaster::getAck(int32_t index) { return ((int32_t *)(m_receipt_frame->data))[index]; } |
|
|
int32_t IflytopCanbusMaster::getAck(int32_t index) { return ((int32_t *)(m_receipt_frame->data))[index]; } |
|
|
|
|
|
|
|
|
uint8_t *IflytopCanbusMaster::getAckBuf() { return m_receipt_frame->data; } |
|
|
uint8_t *IflytopCanbusMaster::getAckBuf() { return m_receipt_frame->data; } |
|
|
int32_t IflytopCanbusMaster::getAckBufLen() { return m_receipt_len - sizeof(zcr_cmd_header_t); } |
|
|
|
|
|
|
|
|
int32_t IflytopCanbusMaster::getAckBufLen() { return m_receipt_frame->datalen; } |
|
|
|
|
|
|
|
|
void IflytopCanbusMaster::writereg(int32_t device_id, int32_t regaddr, int32_t val) { callcmd2(device_id, kmodule_set_reg, regaddr, val); } |
|
|
void IflytopCanbusMaster::writereg(int32_t device_id, int32_t regaddr, int32_t val) { callcmd2(device_id, kmodule_set_reg, regaddr, val); } |
|
|
|
|
|
|
|
@ -165,8 +165,8 @@ void IflytopCanbusMaster::callcmd(int32_t device_id, int32_t cmdid, uint8_t *par |
|
|
zcr_cmd_header_t *frame = (zcr_cmd_header_t *)m_txbuf; |
|
|
zcr_cmd_header_t *frame = (zcr_cmd_header_t *)m_txbuf; |
|
|
int32_t frameLen = paramLen + sizeof(zcr_cmd_header_t) + 1; |
|
|
int32_t frameLen = paramLen + sizeof(zcr_cmd_header_t) + 1; |
|
|
frame->cmdid = cmdid; |
|
|
frame->cmdid = cmdid; |
|
|
if (m_txindex < 60000) { |
|
|
|
|
|
m_txindex = 60000; |
|
|
|
|
|
|
|
|
if (m_txindex > 100) { |
|
|
|
|
|
m_txindex = 0; |
|
|
} |
|
|
} |
|
|
|
|
|
|
|
|
frame->index = m_txindex; |
|
|
frame->index = m_txindex; |
|
@ -216,7 +216,7 @@ void IflytopCanbusMaster::callcmd(int32_t device_id, int32_t cmdid, uint8_t *par |
|
|
} |
|
|
} |
|
|
|
|
|
|
|
|
if (m_receipt_frame->packetType == kptv2_error_ack) { |
|
|
if (m_receipt_frame->packetType == kptv2_error_ack) { |
|
|
int32_t ecode = m_receipt_frame->data[0]; |
|
|
|
|
|
|
|
|
int32_t ecode = *(int32_t *)m_receipt_frame->data; |
|
|
throw zexception(ecode, err::error2str(ecode)); |
|
|
throw zexception(ecode, err::error2str(ecode)); |
|
|
} |
|
|
} |
|
|
return; |
|
|
return; |
|
|