     }
     if ((displayRefreshFlags & DISPLAY_REFRESH_BSY) != 0) {
       if (!isBusy) {
-        TFTscreen.stroke(255, 255, 0);                  // set the font color
+        tft.setTextColor(TFT_YELLOW);
         digitalWrite(40, LOW);
       } else {
-        TFTscreen.stroke(0, 20, 20);
+        tft.setTextColor(TFT_BLACK);
         digitalWrite(40, HIGH);
       }
-      TFTscreen.setTextSize(1);
-      TFTscreen.text("Ready", 50, 115);                // write the text to coordinates
+      tft.setTextSize(1);
+      tft.drawString("Ready", 50, 115, 1);                // write the text to coordinates
       displayRefreshFlags &= ~DISPLAY_REFRESH_BSY;
     }
   }


void displayInitialScreen() {                      // displays "Wait Calibrating at start. To be linked to Motors "L" and "C" calibration process
  // Displays SWR
  TFTscreen.stroke(0, 255, 0);                      // set the font color
  TFTscreen.setTextSize(2);                         // set the font size 2
  TFTscreen.text("SWR", 5, 5);                     // write the text to coordinates
  // Displays L
  TFTscreen.stroke(0, 255, 0); 
  TFTscreen.setTextSize(2);  
  TFTscreen.text("L", 5, 25);
  // Displays uH
  TFTscreen.stroke(0, 255, 0);
  TFTscreen.setTextSize(2);
  TFTscreen.text("uH", 105, 25);
  // Displays C1
  TFTscreen.stroke(0, 255, 0);
  TFTscreen.setTextSize(2);
  TFTscreen.text("C1", 5, 55);
  // Displays pF for C1
  TFTscreen.stroke(0, 255, 0);
  TFTscreen.setTextSize(2);
  TFTscreen.text("pF", 105, 55);
  // Displays C2
  TFTscreen.stroke(0, 255, 0);
  TFTscreen.setTextSize(2);
  TFTscreen.text("C2", 5, 85);
  // Displays pF for C2
  TFTscreen.stroke(0, 255, 0);
  TFTscreen.setTextSize(2);
  TFTscreen.text("pF", 105, 85);
  

  keypad.addEventListener(keypadEvent);             //add an event listener for this keypad


void displaySWR() {                                         // display SWR values
  dtostrf(valueSWR, 5, 2, DisplayValueSWR);
  tft.setTextColor(TFT_GREEN);
  tft.setTextSize(2);
  tft.drawString(DisplayValueSWR, 40, 5, 1);
}

void EraseDisplaySWR() {                                   // erase display SWR values
  tft.setTextColor(TFT_BLACK);
  tft.setTextSize(2);
  tft.drawString(DisplayValueSWR, 40, 5, 1);
}

double stepsToUH(double x) {
