|
|
|
|
@ -311,7 +311,7 @@ void loop(void)
|
|
|
|
|
if (iTimeSend > timeNow)
|
|
|
|
|
return;
|
|
|
|
|
iTimeSend = timeNow + TIME_SEND;
|
|
|
|
|
Send(0, abs(cmd2));
|
|
|
|
|
Send(0, cmd2);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
display.setCursor(0, 30);
|
|
|
|
|
@ -327,7 +327,7 @@ void loop(void)
|
|
|
|
|
|
|
|
|
|
// Calculate test command signal
|
|
|
|
|
|
|
|
|
|
if (motor_test_direction == 1) cmd2 += 1;
|
|
|
|
|
if (motor_test_direction == 1) cmd2 += 1;
|
|
|
|
|
else cmd2 -= 1;
|
|
|
|
|
if (abs(cmd2) > SPEED_MAX_TEST) motor_test_direction = -motor_test_direction;
|
|
|
|
|
|
|
|
|
|
|