Graves

/*     
25102018

gravesmegamaster

graves project
arduino MEGA 2650
Master 
coded from scratch by wylie jones
wyliejones@gmail.com

Graves multi arduino build 10/2018
Arduino mega 2560 with 240/320 tft and micro sd card (for storing screen backgrounds)
two arduino uno's
slave1 arduino uno to sense sound from graves and echo dot to control mouth
slave2 arduino uno to control passive sensor array and head servo

sound is sensed with a simple DC bias circuit to capture line level input to be used as a digital signal

                  analogue pin                    speaker +
                      \ (yellow signal             / (red from speaker)
         10k Ohm       \    wire)                 /
         resistor       \                        /
  *--------/\/\/---------*---------/\/\/--------*
  |                       \       10k Ohm       |
  |                        \      resistor      |
  |(red with white)         \                   |to arduino ground (black with white)
to arduino 5v+           -)|-
                         \    100uF 16v
                          \    capacitor
                           \
                            \
                          speaker -
                        (black from speaker)

*/
//end notes
//end notes
//end notes
//end notes
//end notes
//end notes


//*********************************************************
//<*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*>
//*********************************************************


//begin declarations
//begin declarations
//begin declarations
//begin declarations
//begin declarations
//begin declarations
//begin declarations

//#include <TFT.h>
//#include <Servo.h> 
//#include <stdint.h>
//#include <SD.h>
#include <TFTv2.h>
#include <SPI.h>
#include <SeeedTouchScreen.h> 
//#include <Wire.h>

//const int PIN_SD_CS = 4;                        // pin of sd card

TouchScreen ts = TouchScreen(XP, YP, XM, YM);
int zMax; // maximum pressure to detect
int zMin; // minimum pressure to detect

int buttonPressed; // stores which button was pressed
unsigned long newButtonTime; // debounce
unsigned long oldButtonTime; // debounce
unsigned long buttonTimeDifference; // debounce
unsigned long debounceTime; // debounce
int buttonGroup; // sets kinds of buttons on screen

int currentScreen; // identifies current screen by adding x y and z
int x; // for ones
int y; // for tens
int z; // for hundreds

unsigned long backlightTimer; // for backlight timeout
int backLightState;  // status of backlight 1 for on and 0 for off
unsigned long backlightTimeDifference;
unsigned long newBacklightTime;
unsigned long oldBacklightTime;

char incomingMouthByte;
char outgoingMouthByte;
int mouthOnOffNew;
int mouthOnOffOld;
int mouthOnOffDifference;
int mouthOnOffAdjusted; // value adjusted by 48 for ascii

char incomingHeadByte;
char outgoingHeadByte;
int headOnOffNew;
int headOnOffOld;
int headOnOffDifference;
int headOnOffAdjusted; // value adjusted by 48 for ascii

//end declarations
//end declarations
//end declarations
//end declarations
//end declarations
//end declarations
//end declarations
//end declarations
//end declarations

//*********************************************************
//<*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*>
//*********************************************************

// begin void setup
// begin void setup
// begin void setup
// begin void setup
// begin void setup
// begin void setup
// begin void setup
// begin void setup
// begin void setup
// begin void setup
// begin void setup
void setup() {
Serial.begin(9600);
Serial1.begin(9600);
Serial2.begin(9600);
  oldButtonTime = millis();
  newButtonTime = millis();
  Tft.TFTinit();  // init TFT library
  TFT_BL_ON;      // turn on the background light
  backLightState = 1;
  x = 0;
  y = 0;
  z = 0;
  buttonPressed = 4;
  buttonGroup = 0;

  incomingHeadByte = 1;
  outgoingHeadByte = 1;	// for a bit more talkative serial data
  headOnOffNew = 1; // stores head state from serial connection
  headOnOffOld = 1; // stores head state from serial connection


  incomingMouthByte = 0;
  outgoingMouthByte = 0;	// for a bit more talkative serial data
  mouthOnOffNew = 1; // stores mouth state from serial connection
  mouthOnOffOld = 1; // stores mouth state from serial connection


                   ////////////////////////////////
                   //// manually set variables ////
                   ////////////////////////////////
//                 \/    \/    \/    \/    \/    \/  

        debounceTime = 1000; // button debounce in milliseconds
        zMax = 460; // maximum pressure to detect
        zMin = 100; // minimum pressure to detect

        backlightTimer = 15000; // 5000 = 5 seconds for backlight timeout
                     
//                 /\    /\    /\    /\    /\    /\
                   ////////////////////////////////
                   //// manually set variables ////
                   ////////////////////////////////


  currentScreen = 0;
  callScreen();

} //void setup() 
// end void setup
// end void setup
// end void setup
// end void setup
// end void setup
// end void setup
// end void setup
// end void setup

//*********************************************************
//<*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*>
//*********************************************************

// begin void loop
// begin void loop
// begin void loop
// begin void loop
// begin void loop
// begin void loop
// begin void loop
// begin void loop
// begin void loop
// begin void loop
// begin void loop
// begin void loop
// begin void loop
// begin void loop

void loop() {

  tftBacklightTimeout(); // check time and turn off backlight

  if(buttonGroup == 0){ // most regular pages
    tftButtonGroup0(); // gather information from touch screen touches
    buttonTimeDifference = newButtonTime - oldButtonTime;
    if(debounceTime < buttonTimeDifference){
      whatScreen();
      callScreen();
      oldButtonTime = newButtonTime;
      showStuff(); // serial prints
      tftDisplay(); // display x y coordinates on tft display
    }
  }
  if(buttonGroup == 1){ // on off buttons
    tftButtonGroup1(); // gather information from touch screen touches
    buttonTimeDifference = newButtonTime - oldButtonTime;
    if(debounceTime < buttonTimeDifference){
      whatScreen();
      callScreen();
      oldButtonTime = newButtonTime;
      showStuff(); // serial prints
      tftDisplay(); // display x y coordinates on tft display
      mouthUnoTxRx();
     }
  }
  if(buttonGroup == 2){ // head buttons
    tftButtonGroup2(); // gather information from touch screen touches
    buttonTimeDifference = newButtonTime - oldButtonTime;
    if(debounceTime < buttonTimeDifference){
      whatScreen();
      callScreen();
      oldButtonTime = newButtonTime;
      showStuff(); // serial prints
      tftDisplay(); // display x y coordinates on tft display
      headUnoTxRx();
    }
  }
  if(buttonGroup == 3){ // head buttons
    tftButtonGroup3(); // gather information from touch screen touches
    buttonTimeDifference = newButtonTime - oldButtonTime;
    if(debounceTime < buttonTimeDifference){
      whatScreen();
      callScreen();
      oldButtonTime = newButtonTime;
      showStuff(); // serial prints
      tftDisplay(); // display x y coordinates on tft display
    }
  }


} //void loop() 

// end of void loop
// end of void loop
// end of void loop
// end of void loop
// end of void loop
// end of void loop
// end of void loop
// end of void loop
// end of void loop
// end of void loop
// end of void loop
// end of void loop
// end of void loop
// end of void loop
// end of void loop

//****************************************************************************************************
//<*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*>
//****************************************************************************************************
/////////////////////////////////////////////////////////////////////////////////////////////////////////
/////////////////////////////////////////  functions  ///////////////////////////////////////////////////
/////////////////////////////////////////////////////////////////////////////////////////////////////////
//****************************************************************************************************
//<*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*>
//****************************************************************************************************

//--------------------------begin tftBacklightTimeout----------------------------------
void tftBacklightTimeout(){
  newBacklightTime = millis();
  if(backLightState = 0){
    backlightTimeDifference = newBacklightTime - oldBacklightTime;
    if(backlightTimer > backlightTimeDifference){
      backlightTimeDifference = newBacklightTime - oldBacklightTime;
      TFT_BL_ON;      // turn on the background light
      backLightState = 1;
      oldBacklightTime = millis();
    }
  }
  if(backLightState = 1){
    backlightTimeDifference = newBacklightTime - oldBacklightTime;
    if(backlightTimer < backlightTimeDifference){
      backlightTimeDifference = newBacklightTime - oldBacklightTime;
      TFT_BL_OFF;      // turn off the background light
      backLightState = 0;
      oldBacklightTime = millis();
    }
  }
}
//--------------------------end tftBacklightTimeout----------------------------------

//****************************************************************************************************
//****************************************************************************************************

//--------------------------begin tftButtonGroup0----------------------------------
//--------------------------begin tftButtonGroup0----------------------------------
//--------------------------begin tftButtonGroup0----------------------------------
//--------------------------begin tftButtonGroup0----------------------------------
int tftButtonGroup0(){
  Point p = ts.getPoint();
  if(zMin<p.z && p.z<zMax){
      TFT_BL_ON;      // turn on the background light
      backLightState = 1;
      oldBacklightTime = millis();
    newButtonTime = millis();
    p.x = map(p.x, TS_MINX, TS_MAXX, 0, 240);
    p.y = map(p.y, TS_MINY, TS_MAXY, 0, 320);
//Button 1
    if(75<p.x && p.x<140){
      if(100<p.y && p.y<164){
          buttonPressed = 1;
        }
//Button 2      
      if(164<p.y && p.y<240){
        buttonPressed = 2;
      }
//Button 3      
      if(240<p.y && p.y<310){
         buttonPressed = 3;
      }
    } 
   }
//Button 4      
      if(10<p.x && p.x<75){
        if(100<p.y && p.y<240){
          buttonPressed = 4;
        }
      }
}//void tftButtonGroup0
//--------------------------end tftButtonGroup0 code----------------------------------
//--------------------------end tftButtonGroup0 code----------------------------------
//--------------------------end tftButtonGroup0 code----------------------------------
//--------------------------end tftButtonGroup0 code----------------------------------
//--------------------------end tftButtonGroup0 code----------------------------------
//****************************************************************************************************
//****************************************************************************************************

//--------------------------begin tftButtonGroup1----------------------------------
//--------------------------begin tftButtonGroup1----------------------------------
//--------------------------begin tftButtonGroup1----------------------------------
//--------------------------begin tftButtonGroup1----------------------------------
int tftButtonGroup1(){  // for mouth
buttonPressed = 0;
  Point p = ts.getPoint();
  if(zMin<p.z && p.z<zMax){
      TFT_BL_ON;      // turn on the background light
      backLightState = 1;
      oldBacklightTime = millis();
    newButtonTime = millis();
    p.x = map(p.x, TS_MINX, TS_MAXX, 0, 240);
    p.y = map(p.y, TS_MINY, TS_MAXY, 0, 320);
//Button 1
    if(75<p.x && p.x<140){
      if(100<p.y && p.y<164){
        mouthOnOffNew = 1; // on
        Serial.print("mouthOnOffNew set to ");
        Serial.println(mouthOnOffNew);
        }
//Button 2      
      if(164<p.y && p.y<240){
        mouthOnOffNew = 2; // off
        Serial.print("mouthOnOffNew set to ");
        Serial.println(mouthOnOffNew);
      }
//Button 3      
//      if(240<p.y && p.y<310){
//        mouthOnOffNew = 3; // off
//        Serial.print("mouthOnOffNew set to ");
//        Serial.println(mouthOnOffNew);
//      }
    } 
  }
//Button 4      
      if(10<p.x && p.x<75){
        if(100<p.y && p.y<240){
          buttonPressed = 4;
          buttonGroup = 0;
        }
      }
}//void tftButtonGroup1
//--------------------------end tftButtonGroup1 code----------------------------------
//--------------------------end tftButtonGroup1 code----------------------------------
//--------------------------end tftButtonGroup1 code----------------------------------
//--------------------------end tftButtonGroup1 code----------------------------------
//--------------------------end tftButtonGroup1 code----------------------------------
//****************************************************************************************************
//****************************************************************************************************

//--------------------------begin tftButtonGroup2----------------------------------
//--------------------------begin tftButtonGroup2----------------------------------
//--------------------------begin tftButtonGroup2----------------------------------
//--------------------------begin tftButtonGroup2----------------------------------
int tftButtonGroup2(){  // for mouth
buttonPressed = 0;
  Point p = ts.getPoint();
  if(zMin<p.z && p.z<zMax){
      TFT_BL_ON;      // turn on the background light
      backLightState = 1;
      oldBacklightTime = millis();
    newButtonTime = millis();
    p.x = map(p.x, TS_MINX, TS_MAXX, 0, 240);
    p.y = map(p.y, TS_MINY, TS_MAXY, 0, 320);
//Button 1
    if(75<p.x && p.x<140){
      if(100<p.y && p.y<164){
        headOnOffNew = 1; // on
        Serial.print("headOnOffNew set to ");
        Serial.println(headOnOffNew);
        }
//Button 2      
      if(164<p.y && p.y<240){
        headOnOffNew = 2; // off
        Serial.print("headOnOffNew set to ");
        Serial.println(headOnOffNew);
      }
//Button 3      
//      if(240<p.y && p.y<310){
//         buttonPressed = 3;
//      }
    } 
   }
//Button 4      
      if(10<p.x && p.x<75){
        if(100<p.y && p.y<240){
          buttonPressed = 4;
          buttonGroup = 0;
        }
      }
}//void tftButtonGroup2
//--------------------------end tftButtonGroup2 code----------------------------------
//--------------------------end tftButtonGroup2 code----------------------------------
//--------------------------end tftButtonGroup2 code----------------------------------
//--------------------------end tftButtonGroup2 code----------------------------------
//--------------------------end tftButtonGroup2 code----------------------------------
//****************************************************************************************************
//****************************************************************************************************
//--------------------------begin tftButtonGroup3----------------------------------
//--------------------------begin tftButtonGroup3----------------------------------
//--------------------------begin tftButtonGroup3----------------------------------
//--------------------------begin tftButtonGroup3----------------------------------
int tftButtonGroup3(){  // for tft backlight
buttonPressed = 0;
  Point p = ts.getPoint();
  if(zMin<p.z && p.z<zMax){
      TFT_BL_ON;      // turn on the background light
      backLightState = 1;
      oldBacklightTime = millis();
    newButtonTime = millis();
    p.x = map(p.x, TS_MINX, TS_MAXX, 0, 240);
    p.y = map(p.y, TS_MINY, TS_MAXY, 0, 320);
    if(75<p.x && p.x<140){
//Button 1
      if(100<p.y && p.y<164){
        backlightTimer = 120000;
        }
//Button 2      
      if(164<p.y && p.y<240){
          backlightTimer = 15000;
      }
//Button 3      
      if(240<p.y && p.y<310){
        buttonPressed = 3;
        backlightTimer = 5000;
      }
    } 
   }
//Button 4      
      if(10<p.x && p.x<75){
        if(100<p.y && p.y<240){
          buttonPressed = 4;
          buttonGroup = 0;
        }
      }
}//void tftButtonGroup3
//--------------------------end tftButtonGroup3 code----------------------------------
//--------------------------end tftButtonGroup3 code----------------------------------
//--------------------------end tftButtonGroup3 code----------------------------------
//--------------------------end tftButtonGroup3 code----------------------------------
//--------------------------end tftButtonGroup3 code----------------------------------
//****************************************************************************************************
//****************************************************************************************************

//--------------------------begin mouthUnoTxRx----------------------------------

void mouthUnoTxRx(){
  if(mouthOnOffNew != mouthOnOffOld){
      Serial.println("starting txrx");
    if(mouthOnOffNew == 1){
      Serial.println("Starting tx");
      Serial1.flush();
      Serial1.write('1');
      mouthOnOffOld = 1;
//begin rx
      Serial.println("Starting rx");

      delay(10); // tweak delay to accomodate uno
      
      // use a serial available after flush funtion while or for loop or interrrupt or somethin
      incomingMouthByte = Serial1.read();
      Serial1.flush();
      mouthOnOffAdjusted = incomingMouthByte;
      Serial.print("mouthOnOffAdjusted should be 1: ");
      Serial.println(mouthOnOffAdjusted);
    }
    if(mouthOnOffNew == 2){
      Serial.println("Starting tx");
      Serial1.flush();
      Serial1.write('2');
      mouthOnOffOld = 2;
//begin rx
      Serial.println("Starting rx");

      delay(10); // tweak delay to accomodate uno

      incomingMouthByte = Serial1.read();
      Serial1.flush();
      mouthOnOffAdjusted = incomingMouthByte;
      Serial.print("mouthOnOffAdjusted should be 2: ");
      Serial.println(mouthOnOffAdjusted);
    }
    if(mouthOnOffNew == 3){
      Serial.println("Starting tx");
      Serial1.flush();
      Serial1.write('3');
      mouthOnOffOld = 3;
//begin rx
      Serial.println("Starting rx");

      delay(10); // tweak delay to accomodate uno
      
      // use a serial available after flush funtion while or for loop or interrrupt or somethin
      incomingMouthByte = Serial1.read();
      Serial1.flush();
      mouthOnOffAdjusted = incomingMouthByte;
      Serial.print("mouthOnOffAdjusted should be 3: ");
      Serial.println(mouthOnOffAdjusted);
    }
    if(mouthOnOffNew == 4){
      Serial.println("Starting tx");
      Serial1.flush();
      Serial1.write('4');
      mouthOnOffOld = 4;
//begin rx
      Serial.println("Starting rx");

      delay(10); // tweak delay to accomodate uno
      
      // use a serial available after flush funtion while or for loop or interrrupt or somethin
      incomingMouthByte = Serial1.read();
      Serial1.flush();
      mouthOnOffAdjusted = incomingMouthByte;
      Serial.print("mouthOnOffAdjusted should be 4: ");
      Serial.println(mouthOnOffAdjusted);
    }


    else if(mouthOnOffAdjusted <= 1 && 4 >= mouthOnOffAdjusted){
      Serial.println("error reply wasn't like expected");
      Serial.print("instead, the adjusted reply was");

      delay(10); // tweak delay to accomodate uno

      incomingMouthByte = Serial1.read();
      Serial1.flush();
      mouthOnOffAdjusted = incomingMouthByte;
      Serial.print("mouthOnOffAdjusted: ");
      Serial.println(mouthOnOffAdjusted);
    }
  }
  else if(mouthOnOffOld = mouthOnOffNew){
  }
  Serial.flush();
  Serial1.flush();
}

//--------------------------end mouthUnoTxRx --------------------------------------
//-----*-----*-----*-----*-----*-----*-----*-----*-----*-----*-----*-----*-----*-----
//--------------------------begin headUnoTxRx----------------------------------

void headUnoTxRx(){
  if(headOnOffNew != headOnOffOld){
      Serial.println("starting txrx");
    if(headOnOffNew == 1){
      Serial.println("Starting tx");
      Serial2.flush();
      Serial2.write('1');
      headOnOffOld = 1;
//begin rx
      Serial.println("Starting rx");

      delay(10); // tweak delay to accomodate uno
      
      // use a serial available after flush funtion while or for loop or interrrupt or somethin instead of delay
      incomingHeadByte = Serial2.read();
      Serial2.flush();
      headOnOffAdjusted = incomingHeadByte;
      Serial.print("headOnOffAdjusted should be 1: ");
      Serial.println(headOnOffAdjusted);
    }
    if(headOnOffNew == 2){
      Serial.println("Starting tx");
      Serial2.flush();
      Serial2.write('2');
      headOnOffOld = 2;
//begin rx
      Serial.println("Starting rx");

      delay(10); // tweak delay to accomodate uno

      incomingHeadByte = Serial2.read();
  Serial2.flush();
      headOnOffAdjusted = incomingHeadByte;
      Serial.print("headOnOffAdjusted should be 2: ");
      Serial.println(headOnOffAdjusted);
    }
    else if(headOnOffAdjusted != 1 && headOnOffAdjusted != 2){
      Serial.println("error reply wasn't like expected");
      Serial.print("instead, the adjusted reply was");

      delay(10); // tweak delay to accomodate uno

      incomingHeadByte = Serial2.read();
      Serial2.flush();
      headOnOffAdjusted = incomingHeadByte;
      Serial.print("headOnOffAdjusted: ");
      Serial.println(headOnOffAdjusted);
    }
  }
  else if(headOnOffOld = headOnOffNew){
  }
  Serial.flush();
  Serial2.flush();
}

//--------------------------end headUnoTxRx --------------------------------------
//****************************************************************************************************
//****************************************************************************************************

//--------------------------begin tftDisplay code----------------------------------
void tftDisplay(){
  Point p = ts.getPoint();
  p.x = map(p.x, TS_MINX, TS_MAXX, 0, 240);
  p.y = map(p.y, TS_MINY, TS_MAXY, 0, 320);

      Tft.fillRectangle(70, 100, 60, 30, BLACK);
      Tft.drawNumber((buttonGroup), 70, 100, 3, GREEN);
      Tft.fillRectangle(140, 100, 60, 30, BLACK);
      Tft.drawNumber((mouthOnOffNew), 140, 100, 3, GREEN);
      Tft.fillRectangle(160, 100, 60, 30, BLACK);
      Tft.drawNumber((headOnOffNew), 160, 100, 3, GREEN);
      Tft.fillRectangle(0, 225, 60, 30, BLACK);
      Tft.drawNumber((p.x), 0, 225, 3, GREEN);
      Tft.fillRectangle(180, 225, 60, 30, BLACK);
      Tft.drawNumber((p.y), 180, 225, 3, GREEN);
      Tft.fillRectangle(100, 225, 60, 30, BLACK);
      Tft.drawNumber((buttonPressed), 100, 225, 3, GREEN);
      Tft.fillRectangle(120, 290, 60, 30, BLACK);
      Tft.drawNumber((currentScreen), 120, 290, 3, GREEN);


}// void tftDisplay
//--------------------------end tftDisplay code------------------------------------

//****************************************************************************************************
//****************************************************************************************************

//-------------------------- begin mouth on off function --------------------------
//-------------------------- end mouth on off function --------------------------

//****************************************************************************************************
//****************************************************************************************************

//-------------------------- begin head on off function --------------------------
//-------------------------- end head on off function -------------------------

//****************************************************************************************************
//****************************************************************************************************

//-------------------------- begin serial display function --------------------------
void showStuff(){
   Serial.println("------/ last update /-------");
//   Serial.println("------begin display-------");
   Serial.print("buttonPressed ");
   Serial.println(buttonPressed);
   Serial.print("x ");
   Serial.println(x);
   Serial.print("y ");
   Serial.println(y);
   Serial.print("z ");
   Serial.println(z);
   Serial.print("currentScreen ");
   Serial.println(currentScreen);
//   Serial.println("-------end display--------");
   Serial.println("");
   Serial.println("");
   Serial.println("");
 }
//-------------------------- end serial display function -------------------------


//****************************************************************************************************
//****************************************************************************************************

//--------------------------- Primary screen maps --------------------------------
/*



screen 0000  A)Main Controls

  screen 0001  a)motor controls

  screen 0001  b) Touch Screen Timeout
    screen 0011  -longer
    screen 0011  -shorter
    screen 0011  -reset

  screen 0001  c)sensor monitors
    screen 0021  -head reports
      screen 0121  *report pir detection
      screen 0121  *report pot position
    screen 0021  -mouth reports
      screen 0221  *graves sense
      screen 0221  *echo sense
      screen 0221  *report mouth servo position
//      screen 0221  *adjust sensitivity?

screen 0000  B)Mouth Control

  screen 0002  a)test button
    screen 0012  -open
    screen 0012  -close

  screen 0002  b)sound sensors on/off  

    screen 0022  -echo sense
      screen 0122  *on
      screen 0122  *off
      screen 0122  *monitor sensor

    screen 0022  -graves sense
      screen 0222  *on
      screen 0222  *off    
      screen 0222  *monitor sensors

  screen 0002  c)sound sensor status
    screen 0032  -echo
    screen 0032  -graves

screen 0000  C)Head Control
  screen 0003  a)head motor on/off
    screen 0013  -on
    screen 0013  -off
  screen 0003  b)manual point
    screen 0023  -slider
*/
//****************************************************************************************************
//****************************************************************************************************
//-------------------------- begin whatScreen function -------------------------
//-------------------------- begin whatScreen function -------------------------
//-------------------------- begin whatScreen function -------------------------
//-------------------------- begin whatScreen function -------------------------

int whatScreen(){
    if(x == 0){
      if(buttonPressed == 1){
        x = x + 1;
        Serial.println("x + 1");
      }
      if(buttonPressed == 2){
        x = x + 2;
        Serial.println("x + 2");
      }
      if(buttonPressed == 3){
        x = x + 3;
        Serial.println("x + 3");
      }
      if(buttonPressed == 4){
        x = 0;
        Serial.println("x = 0");
      }
      if(buttonPressed == 5){
        x = 0;
        y = 0;
        z = 0;
        Serial.println("xyz all 0");
      }
    }
    else if(x >> 0){
      if(y == 0){
        if(buttonPressed == 1){
          y = y + 10;
          Serial.println("y + 10");
        }
        if(buttonPressed == 2){
          y = y + 20;
          Serial.println("y + 20");
        }
        if(buttonPressed == 3){
          y = y + 30;
          Serial.println("y + 30");
        }
        if(buttonPressed == 4){
          x = 0;
          Serial.println("x = 0");
        }
        if(buttonPressed == 5){
          x = 0;
          y = 0;
          z = 0;
          Serial.println("xyz all 0");
        }
      }  
      else if (y >> 0){
          if(buttonPressed == 1){
            z = z + 100;
            Serial.println("z + 100");
          }
          if(buttonPressed == 2){
            z = z + 200;
            Serial.println("z + 200");
          }
          if(buttonPressed == 3){
            if(currentScreen != 31){
            z = z + 300;
            Serial.println("z + 300");
          }
          }
          if(buttonPressed == 4){
            if(z == 0){
              y = 0;
              Serial.println("y = 0");
            }
            else if(z >> 0){
              z = 0;
              Serial.println("z = 0");
            }
          }
          if(buttonPressed == 5){
            x = 0;
            y = 0;
            z = 0;
            Serial.println("xyz all 0");
          }
        }//y>0
      }//x>0
  currentScreen = z+y+x;
  
  
//================button group exceptions================
//================button group exceptions================
  if(currentScreen == 111){ // HEAD MOTOR CONTOL
    buttonGroup=1;
  }
  if(currentScreen == 12){ // MOUTH MOTOR CONTOL
    buttonGroup=1;
  }
  if(currentScreen == 13){ // HEAD MOTOR CONTOL
    buttonGroup=2;
  }
  if(currentScreen == 211){ // MOUTH MOTOR CONTOL
    buttonGroup=2;
  }
  if(currentScreen == 31){ // BACKLIGHTIMER
    buttonGroup=3;
  }
//================button group exceptions================
//================button group exceptions================

}
//-------------------------- end whatScreen function -------------------------
//-------------------------- end whatScreen function -------------------------
//-------------------------- end whatScreen function -------------------------
//-------------------------- end whatScreen function -------------------------
//-------------------------- end whatScreen function -------------------------

//****************************************************************************************************
//<*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*>
//****************************************************************************************************
//\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\
//\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\ screens \\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\
//\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\\
//****************************************************************************************************
//<*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*><*>
//****************************************************************************************************
//-------------------------- begin callScreen function -------------------------
//-------------------------- begin callScreen function -------------------------
//-------------------------- begin callScreen function -------------------------
//-------------------------- begin callScreen function -------------------------
//-------------------------- begin callScreen function -------------------------
//-------------------------- begin callScreen function -------------------------
//-------------------------- begin callScreen function -------------------------
//-------------------------- begin callScreen function -------------------------
//-------------------------- begin callScreen function -------------------------
//-------------------------- begin callScreen function -------------------------
//-------------------------- begin callScreen function -------------------------

int callScreen(){
      Tft.fillRectangle(0, 0, 240, 320, BLACK);

//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> begin screen 0000 master <><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>
if(currentScreen == 0){  
                 //  "             "
      Tft.drawString("GRAVES",0,5,4,  GREEN);
      Tft.drawString("INTERFACE",18,50,4,GREEN);
      Tft.drawString("Main Controls", 05,130, 3, GREEN);
      Tft.drawString("Mouth Control", 05, 195, 3, CYAN);
      Tft.drawString("Head Control", 10, 260, 3, BLUE);
}
//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> end screen 0000 master <><><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>

//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> begin screen 0001 <><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>
     if(currentScreen == 1){  
                 //  "             "
      Tft.drawString("MAIN", 65, 5, 4, GREEN);
      Tft.drawString("CONTROLS", 25, 50, 4, GREEN);
      Tft.drawString("Motors Power", 15, 130, 3, RED);
      Tft.drawString("Sensors", 55, 195, 3, YELLOW);
      Tft.drawString("Light Timeout", 5, 260, 3, WHITE);
      Tft.drawString("<", 0, 160, 3, GREEN); // back button
}
//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> end screen 0001 <><><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>


//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> begin screen 0011 <><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>
     if(currentScreen == 11){  
                 //  "             "
      Tft.drawString("MOTOR", 60, 5, 4, RED);
      Tft.drawString("CONTROLS", 20, 50, 4, RED);
      Tft.drawString("Head Motor", 30, 130, 3, BLUE);
      Tft.drawString("Mouth Motor", 25, 195, 3, CYAN);
      Tft.drawString("<", 0, 160, 3, GREEN); // back button
}
//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> end screen 0013 <><><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>

//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> begin screen 0111 <><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>
     if(currentScreen == 111){  
                 //  "             "
      Tft.drawString("HEAD MOTOR",0,5,4,BLUE);
      Tft.drawString("CONTROL", 40, 50, 4, BLUE);
      Tft.drawString("On", 100, 130, 3, GREEN);
      Tft.drawString("Off", 95, 195, 3, RED);
      Tft.drawString("<", 0, 160, 3, GREEN); // back button
}
//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> end screen 0111 <><><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>

//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> begin screen 0211 <><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>
     if(currentScreen == 211){  
                 //  "             "
      Tft.drawString("MOUTH", 60, 5, 4, CYAN);
      Tft.drawString("MOTOR", 60, 50, 4, CYAN);
      Tft.drawString("On", 100, 130, 3, GREEN);
      Tft.drawString("Off", 95, 195, 3, RED);
      Tft.drawString("<", 0, 160, 3, GREEN); // back button
}
//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> end screen 0211 <><><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>

//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> begin screen 0031 <><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>
     if(currentScreen == 31){  
                 //  "             "
      Tft.drawString("BACKLIGHT",10,5,4,WHITE);
      Tft.drawString("TIME OUT",20,50,4,WHITE);
      Tft.drawString("2 minutes", 35,130, 3, GREEN);
      Tft.drawString("15 seconds", 30, 195, 3, RED);
      Tft.drawString("5 seconds", 35, 260, 3, WHITE);
      Tft.drawString("<", 0, 160, 3, GREEN); // back button
}

//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> end screen 0031 <><><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>

//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> begin screen 0021 <><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>
     if(currentScreen == 21){  
                 //  "             "
      Tft.drawString("INCOMING", 20, 5, 4, GREEN);
      Tft.drawString("SENSORS", 30, 50, 4,YELLOW);
      Tft.drawString("Head Sensors", 15, 130, 3, YELLOW);
      Tft.drawString("Mouth Sensors", 05, 195, 3, YELLOW);
      Tft.drawString("<", 0, 160, 3, GREEN); // back button
}
//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> end screen 0021 <><><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>

//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> begin screen 0121 <><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>
     if(currentScreen == 121){  
                 //  "             "
      Tft.drawString("HEAD", 65, 5, 4, BLUE);
      Tft.drawString("SENSORS", 30, 50, 4, YELLOW);
      Tft.drawString("PIR position ", 10, 130, 3, YELLOW);
      Tft.drawString("detected", 05, 195, 3, YELLOW);
      Tft.drawChar(incomingHeadByte, 185, 195, 3, YELLOW);
      Tft.drawString("<", 0, 160, 3, GREEN); // back button
}
//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> end screen 0121 <><><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>

//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> begin screen 0221 <><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>
     if(currentScreen == 221){  
                 //  "             "
      Tft.drawString("MOUTH", 55, 5, 4, CYAN);
      Tft.drawString("SENSORS", 30, 50, 4, YELLOW);
      Tft.drawString("Echo Sense", 30, 130, 3, YELLOW);
      Tft.drawString("Graves Sense", 10, 195, 3, YELLOW);
      Tft.drawString("<", 0, 160, 3, GREEN); // back button
}
//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> end screen 0221 <><><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>


//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> begin screen 0002 <><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>
     if(currentScreen == 2){
                 //  "             "
      Tft.drawString("MOUTH", 50, 5, 4, CYAN);
      Tft.drawString("CONTROL", 30, 50, 4, CYAN);
      Tft.drawString("Motor on/off", 15, 130, 3, RED);
      Tft.drawString("Sensor on/off", 05, 195, 3, YELLOW);
      Tft.drawString("Monitor", 5, 260, 3, YELLOW);
      Tft.drawChar(incomingMouthByte, 185, 260, 3, YELLOW);
      Tft.drawString("<", 0, 160, 3, GREEN); // back button
     }
//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> end screen 0002 <><><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>


//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> begin screen 0012 <><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>
     if(currentScreen == 12){  
                 //  "             "
      Tft.drawString("MOUTH", 60, 5, 4, CYAN);
      Tft.drawString("MOTOR", 60, 50, 4, CYAN);
      Tft.drawString("On", 100, 130, 3, GREEN);
      Tft.drawString("Off", 95, 195, 3, RED);
      Tft.drawString("<", 0, 160, 3, GREEN); // back button
}
//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> end screen 0012 <><><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>


//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> begin screen 0022 <><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>
     if(currentScreen == 22){  
                 //  "             "
      Tft.drawString("SENSOR", 40, 5, 4, YELLOW);
      Tft.drawString("SELECT", 40, 50, 4,YELLOW);
      Tft.drawString("Echo Sense", 30, 130, 3, YELLOW);
      Tft.drawString("Graves Sense", 10, 195, 3, YELLOW);
      Tft.drawString("Monitor Both", 10, 260, 3, YELLOW);
      Tft.drawString("<", 0, 160, 3, GREEN); // back button
}
//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> end screen 0022 <><><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>



//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> begin screen 0122 <><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>
     if(currentScreen == 122){  
                 //  "             "
      Tft.drawString("ECHO", 70, 5, 4, YELLOW);
      Tft.drawString("SENSOR", 35, 50, 4, YELLOW);
      Tft.drawString("On", 100, 130, 3, GREEN);
      Tft.drawString("Off", 95, 195, 3, RED);
      Tft.drawString("Monitor", 5, 260, 3, GREEN);
      Tft.drawChar(incomingMouthByte, 185, 260, 3, YELLOW);
      Tft.drawString("<", 0, 160, 3, GREEN); // back button
}
//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> end screen 0122 <><><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>

//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> begin screen 0222 <><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>
     if(currentScreen == 222){  
                 //  "             "
      Tft.drawString("GRAVES",35,5,4,BLUE);
      Tft.drawString("SENSOR",35,50,4,YELLOW);
      Tft.drawString("On", 100, 130, 3, GREEN);
      Tft.drawString("Off", 95, 195, 3, RED);
      Tft.drawString("Monitor", 5, 260, 3, GREEN);
      Tft.drawChar(incomingMouthByte, 185, 260, 3, YELLOW);
      Tft.drawString("<", 0, 160, 3, GREEN); // back button
}
//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> end screen 0222 <><><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>

//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> begin screen 0032 <><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>
     if(currentScreen == 32){  
                 //  "             "
      Tft.drawString("ALL", 90, 5, 4, BLUE);
      Tft.drawString("SENSORS", 35, 50, 4, YELLOW);
      Tft.drawString("Echo", 35, 130, 3, BLUE);
      Tft.drawChar(incomingMouthByte, 185, 130, 3, YELLOW);
      Tft.drawString("Graves", 30, 195, 3, GREEN);
      Tft.drawChar(incomingMouthByte, 185, 130, 3, YELLOW);
      Tft.drawString("<", 0, 160, 3, GREEN); // back button
}
//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> end screen 0032 <><><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>

//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> begin screen 0003 <><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>
     if(currentScreen == 3){  
                 //  "             "
      Tft.drawString("HEAD", 70, 5, 4, BLUE);
      Tft.drawString("CONTROL", 30, 50, 4, RED);
      Tft.drawString("Motor On/Off", 15, 130, 3, RED);
      Tft.drawString("Manual Point", 15, 195, 3, RED);
      Tft.drawString("<", 0, 160, 3, GREEN); // back button
}
//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> end screen 0003 <><><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>

//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> begin screen 0013 <><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>
     if(currentScreen == 13){  
                 //  "             "
      Tft.drawString("HEAD", 70, 5, 4, BLUE);
      Tft.drawString("MOTOR", 60, 50, 4, RED);
      Tft.drawString("On", 100, 130, 3, GREEN);
      Tft.drawString("Off", 95, 195, 3, RED);
      Tft.drawString("<", 0, 160, 3, GREEN); // back button
}
//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> end screen 0013 <><><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>

//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> begin screen 0023 <><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>
     if(currentScreen == 23){  
                 //  "             "
      Tft.drawString("HEAD", 70, 5, 4, BLUE);
      Tft.drawString("POINTER", 35, 50, 4, RED);
      Tft.drawString("Left", 85, 130, 3, RED);
      Tft.drawString("Right", 75, 195, 3, RED);
      Tft.drawString("Center", 65, 260, 3, RED);
      Tft.drawString("<", 0, 160, 3, GREEN); // back button
}
//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> end screen 0023 <><><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>


//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> begin screen 0422 <><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>
     if(currentScreen == 422){  
                 //  "             "
      Tft.drawString("Command Sent",0,5,3,BLUE);
      Tft.drawString("Press Back to",0,55,3,YELLOW);
      Tft.drawString("Contiue", 50,105, 3, BLUE);
      Tft.drawString("<", 0, 160, 3, GREEN); // back button
}
//<><><><><><><><><><><><><><><><><><><><><><><><>
//<><><><><><><><> end screen 0422 <><><><><><><><><>
//<><><><><><><><><><><><><><><><><><><><><><><><>


////<><><><><><><><><><><><><><><><><><><><><><><><>
////<><><><><><><><> begin screen lost <><><><><><><><>
////<><><><><><><><><><><><><><><><><><><><><><><><>
//     else if(currentScreen){  
//                 //  "             "
//      Tft.drawString("Screen not",0,5,3,BLUE);
//      Tft.drawString("found. Please",40,50,3,YELLOW);
//      Tft.drawString("use the back", 80,130, 3, BLUE);
//      Tft.drawString("button to", 05, 195, 3, GREEN);
//      Tft.drawString("return to fun", 10, 260, 3, GREEN);
//      Tft.drawString("<", 0, 160, 3, GREEN); // back button
//}
////<><><><><><><><><><><><><><><><><><><><><><><><>
////<><><><><><><><> end screen lost <><><><><><><><><>
////<><><><><><><><><><><><><><><><><><><><><><><><>


}// callScreen
//-------------------------- end callScreen function -------------------------
//-------------------------- end callScreen function -------------------------
//-------------------------- end callScreen function -------------------------
//-------------------------- end callScreen function -------------------------
//-------------------------- end callScreen function -------------------------
//-------------------------- end callScreen function -------------------------
//-------------------------- end callScreen function -------------------------
//-------------------------- end callScreen function -------------------------
//-------------------------- end callScreen function -------------------------
//-------------------------- end callScreen function -------------------------
//-------------------------- end callScreen function -------------------------
//-------------------------- end callScreen function -------------------------
//-------------------------- end callScreen function -------------------------


//****************************************************************************************************
//****************************************************************************************************







//****************************************************************************************************
//****************************************************************************************************

// fin