   Serial.begin(115200);
   Serial2.begin(TS_PORT_BITRATE);
   pinMode(40, OUTPUT);
+  tft.init();
+  tft.setRotation(1);                               // initialise TFT screen
   busInit(busReceiver, 2, &Serial2);
-  tft.init();
-  tft.setRotation(1);
   tft.fillScreen(TFT_BLACK);
   displayInitialScreen();
 

#define rst  8

// create an instance of the TFT library
TFT_ST7735 tft = TFT_ST7735(128, 128);

#define DISPLAY_REFRESH_L   0x01
#define DISPLAY_REFRESH_C1  0x02

          +  1.0154127876671653e-024 * pow(x, 9);
}

void displayValueC1pF() {                                         // display C1 values in pF
  dtostrf(stepsC1topF(valueRotateC1), 4, 1, DisplayValueC1pF);
  if (isBusy) {
    tft.setTextColor(TFT_YELLOW);
  } else {
    tft.setTextColor(TFT_GREEN);
  }
  tft.setTextSize(1);
  tft.drawString(DisplayValueC1pF, 50, 75, 4);
}

void ErasDisplayValueC1pF() {                                   // erase display C1 values in pF
  tft.setTextColor(TFT_BLACK);
  tft.setTextSize(1);
  tft.drawString(DisplayValueC1pF, 50, 75, 4);
}

void displayC1steps() {                                       // display C1 steps values
  dtostrf(valueRotateC1, 5, 0, DisplayValueC1);
  if (isBusy) {
