|
|
|
|
@ -199,13 +199,15 @@ void loop(void)
|
|
|
|
|
return;
|
|
|
|
|
iTimeSend = timeNow + TIME_SEND;
|
|
|
|
|
Send(0, abs(iTest));
|
|
|
|
|
|
|
|
|
|
display.setCursor(0, 30);
|
|
|
|
|
display.setTextSize(1); // Draw 1X-scale text
|
|
|
|
|
display.setTextColor(SSD1306_WHITE);
|
|
|
|
|
display.print("Speed : ");
|
|
|
|
|
display.setCursor(40, 30);
|
|
|
|
|
display.print(" ");
|
|
|
|
|
display.setCursor(40, 30);
|
|
|
|
|
display.setCursor(45, 30);
|
|
|
|
|
display.print(" ");
|
|
|
|
|
display.display();
|
|
|
|
|
display.setCursor(45, 30);
|
|
|
|
|
display.print(iTest);
|
|
|
|
|
display.display();
|
|
|
|
|
// Calculate test command signal
|
|
|
|
|
|