|
|
@ -740,7 +740,7 @@ bool FeiTeServoMotor::read_regs(uint8_t id, uint8_t add, uint8_t* data, uint8_t |
|
|
|
} |
|
|
|
bool FeiTeServoMotor::tx_and_rx(cmd_header_t* txheader, uint8_t txdatalen, receipt_header_t* rx, uint8_t rxlen, int32_t overtimems) { |
|
|
|
for (int i = 0; i < 5; i++) { |
|
|
|
if (i != 0) osDelay(30); |
|
|
|
if (i != 0) osDelay(50); |
|
|
|
|
|
|
|
bool suc = _tx_and_rx((uint8_t*)txheader, txdatalen, (uint8_t*)rx, rxlen, overtimems); |
|
|
|
if (!suc) continue; |
|
|
|