|
|
@ -26,10 +26,12 @@ static void motorErrorFlag_set(int subindex, bool val) { |
|
|
|
} |
|
|
|
|
|
|
|
static void onMotorMonitorTimer(void const* argument) { |
|
|
|
return; |
|
|
|
// 电机异常检查
|
|
|
|
TmcMotorGroup* DEVICE = (TmcMotorGroup*)argument; |
|
|
|
report_exeception_data_t data; |
|
|
|
for (size_t i = 0; i < DEVICE->motorNum(); i++) { |
|
|
|
ZLOGI(TAG, "check motor %d", i); |
|
|
|
bool estate = motorErrorFlag_get(i); |
|
|
|
|
|
|
|
if (!DEVICE->motor(i)->ping()) { |
|
|
|