|
|
@ -180,8 +180,9 @@ void TmcMotorGroup::fn_pump_rotate(ProcessContext* cxt) { |
|
|
|
ZLOGI(TAG, "pump_rotate: %d %d", GET_PARAM(0), velocity); |
|
|
|
|
|
|
|
motor(GET_PARAM(0))->enable(false); |
|
|
|
motor(GET_PARAM(0))->refreshcfg(); |
|
|
|
motor(GET_PARAM(0))->enable(true); |
|
|
|
motor(GET_PARAM(0))->moveToEnd(velocity > 0 ? 1 : -1, abs(velocity)); |
|
|
|
motor(GET_PARAM(0))->rotate(velocity); |
|
|
|
|
|
|
|
zcanbus_send_ack(cxt->packet, NULL, 0); |
|
|
|
motorErrorFlag_set(GET_PARAM(0), false); |
|
|
|