 	calculateL();                                     // calculate L value at given frequency and C value
 	calculateStepsL();                                // calculate steps needed to move C to value L
 	LmoveStage1();                                    // send command to nano to move motor "L" to L step value
-	EraseDisplayC(), EraseDisplayL();                 // clear previous values L and C at display
-	displayC(), displayL();                           // display current values L and C at display
+	EraseDisplayC1(), EraseDisplayL();                 // clear previous values L and C at display
+	displayC1(), displayL();                           // display current values L and C at display
 	mechSetPosition(round (valueRotateL), round (valueRotateC1), round (valueRotateC2));
 	// End STAGE 1 tuning process
 }

float KHz;                  // KHz constant
float PlanckTime;           // Planck constant
float pi;                   // π constant
float valueC = 0;           // calculated value C float
float valueCEffective = 0;  // calculated value C float
float valueL = 0;           // calculated value L float
float valueCorr = 0;        // calculated value C float
float valueLcorr = 0;       // calculated value L float
float Cmult;                // constant multiplier to calculate C value
float Lmult;                // constant multiplier to calculate L value

int i;


// --- Keypad code start ---
const byte ROWS = 5; // Five rows
const byte COLS = 4; // Four columns
// Define the Keymap
char keys[ROWS][COLS] = {
// Buttons association 1=1 2=2 3=3 4=4 5=5 6=6 7=7 8=8 9=9 0=0 *=Led OFF #=Led ON
// TOP Buttons  C c L l
//Buttons in middle H U D S

// COL0-pin1, COL1-pin2, COL2-pin3, COL3-pin4 
  {'S', '1', '2', '3'}, // ROW0-pin5      
  {'K', '4', '5', '6'}, // ROW1-pin6
  {'U', '7', '8', '9'}, // ROW2-pin7      
  {'D', '*', '0', '#'}, // ROW3-pin8
  {'c', 'C', 'h', 'H'}  // ROW4-pin9
       
};

// Connect keypad ROW0 Pad pin ->> 5=30 <<- pin Mega, ROW1 6=32, ROW2 7=23, ROW3 8=25, ROW4 9=27
byte rowPins[ROWS] = { 30, 32, 23, 25, 27 };
