Simon_Trampolines.ino

/*
 Started: 6-19-2007
 Spark Fun Electronics
 Nathan Seidle
 
 Simon Says is a memory game. Start the game by pressing one of the four buttons. When a button lights up, 
 press the button, repeating the sequence. The sequence will get longer and longer. The game is won after 
 13 rounds.
 
 This code is public domain but you buy me a beer if you use this and we meet someday (Beerware license).
 
 Simon Says game originally written in C for the PIC16F88.
 Ported for the ATmega168, then ATmega328, then Arduino 1.0.
 Fixes and cleanup by Joshua Neal <joshua[at]trochotron.com>
 
 Generates random sequence, plays music, and displays button lights.
 
 Simon tones from Wikipedia
 - A (red, upper left) - 440Hz - 2.272ms - 1.136ms pulse
 - a (green, upper right, an octave higher than A) - 880Hz - 1.136ms,
 0.568ms pulse
 - D (blue, lower left, a perfect fourth higher than the upper left) 
 587.33Hz - 1.702ms - 0.851ms pulse
 - G (yellow, lower right, a perfect fourth higher than the lower left) - 
 784Hz - 1.276ms - 0.638ms pulse
 
 The tones are close, but probably off a bit, but they sound all right.
 
 The old version of SparkFun simon used an ATmega8. An ATmega8 ships
 with a default internal 1MHz oscillator.  You will need to set the
 internal fuses to operate at the correct external 16MHz oscillator.
 
 Original Fuses:
 avrdude -p atmega8 -P lpt1 -c stk200 -U lfuse:w:0xE1:m -U hfuse:w:0xD9:m
 
 Command to set to fuses to use external 16MHz: 
 avrdude -p atmega8 -P lpt1 -c stk200 -U lfuse:w:0xEE:m -U hfuse:w:0xC9:m
 
 The current version of Simon uses the ATmega328. The external osciallator
 was removed to reduce component count.  This version of simon relies on the
 internal default 1MHz osciallator. Do not set the external fuses.

 3/2/2016
 Pete Lewis
 Modifying code to work better for trampolines

1) 
 Fix bug on startup when all four players are standing on trampolines
 -I think this is something to do with the variable keeping track of if trampolines have been "up" meaning someone jumped up or steped off completely.
  - This is necessary so that you can stand on the trampolines or "walk" from one to another. It makes the triggering occur only when a trampoline crosses the threshold
   - of high to low. FIXED 3/2/2016

2)
 Increase playback speed as sequence grows. This will allow for faster playing. We are planning on having groups of 4 play for 2 minutes, so they need to be able to try a few times,
 and potentially win a round within that time frame. ADDED 3/2/2016

3)
  One of the tablah sounds is too low for the computer speakers to actually make, so I need to change this to a sound that will be heard.
  Also, it could be good to choose some more groups to add variety. FIXED 3/2/2016

4) 
Add some code to avoid repeating the same button more than 2 times in a sequence DONE 3/2/2016 - mostly happens in add_to_moves()

5)
Ensure that each button gets chosen an equal amount. This will ensure that when you are playing four player trampolines, everyone gets to jump. 


 
 */

#include "hardware_versions.h"
#include "pitches.h" // Used for the MODE_BEEGEES, for playing the melody on the buzzer!

// Define game parameters
int ROUNDS_TO_WIN = 8; //Number of rounds to succesfully remember before you win. 13 is do-able. 8 is more do-able on trampolines :)
int MAX_seq_repeat = 2; // Max sequence repeat. Used to ensure variety in pattern. NOTE, this must be changed if you change rounds to win
#define ENTRY_TIME_LIMIT   12000 //Amount of time to press a button before game times out. 3000ms = 3 sec

#define MODE_MEMORY  0
#define MODE_BATTLE  1
#define MODE_BEEGEES 2
#define MODE_COMBO_BUTTON 3
#define MODE_MUSICAL_INST 4
#define MODE_WACK_A_MOLE 5

int button_leds[] = {13,9,10};

#define NUM_OF_TRAMPOLINES 3

// Game state variables
byte gameMode = MODE_MUSICAL_INST; //By default, let's play musical instrument - aka free jump
byte gameBoard[32]; //Contains the combination of buttons as we advance
byte gameRound = 0; //Counts the number of succesful rounds the player has made it through
boolean debug = true; // turn on/off debug for development

// TRAMPOLINE EXTENTION STUFF
boolean trampoline = true; // this changes the delay before start game to 1 sec
                           // in order for the flag servors to settle.
                           // Also effects the button sensing to not require a release, 
                           // this helps when transitioning or "walking" from tramp to tramp.
  
// FOUR variables to keep track of each trampoline status.
// To register a true jump on a trampoline, 
// we are looking for when the trampoline changes from HIGH (not standing on it) to LOW (standing on it)
// This is different than bressing a button,
// Because when pressing a button, we wait for the release moment to actually trigger the button
// When jumping on trampolines, we want to the trigger point to be exactly when a tampoline transitions
// from HIGH to LOW. This means that the player could still hold the previous trampoline LOW 
// (i.e. that could have one foot on the previous step)
// and still use their other foot to trigger the next step.
// These four variables keep track of how long each trampoline has been in the HIGH state
// Doing this, allows us to require that a trampoline be in the HIGH state for a certain
// amount of time. This helps debounce and prevent false triggering.

long T_distance[4] = {0,0,0,0};
boolean T_boolean[4] = {0,0,0,0};

bool attract_mode_bool = true;

// 3/2/2016, initiating all of these to 0, so that you can start a round standing on one trampoline, or any combo.

int HIGH_COUNTER_RED = 0;
int HIGH_COUNTER_GREEN = 0;
int HIGH_COUNTER_BLUE = 0;
int HIGH_COUNTER_YELLOW = 0;

// Adding in counters to keep track of how many times each button has been added to the sequence,
// these will be used to avoid "favoring" a certain button, and ensure that each player gets to jump :)
// these will be adjusted in "add_to_moves()" and reset before each new round.

int RED_seq_count = 0;
int GREEN_seq_count = 0;
int BLUE_seq_count = 0;
int YELLOW_seq_count = 0;

// ULTRA_SONIC RANGE FINDER SETUP STUFF
#define trigPin 12
#define echoPin 2
#define echoPin2 3
#define echoPin3 4
#define echoPin4 8

int mode_ADC_reading;
int button_value[7] = {90, 168, 234, 290, 339, 381, 419};

//long threshold_up = 1000;

// EXT MIDI TRIG STUFF
// This is used to trigger the Music Instrument Shield
// This makes for more fun sounds than the buzzer can do
// check out the tab "EXT_MIDI_TRIG" for more info
boolean midi = true; // turn on/off midi in toner fundtions
#include <SoftwareSerial.h>
SoftwareSerial mySerial(15, 14); // RX (not used), TX
byte note = 72; //whistle
byte bank = 0x00; //GM
byte resetMIDI = 7; //Tied to VS1053 Reset line
int notes[] = { // fun notes found in the drum bank. grouped in 4.
  70,72,74,75,
}; // Note, if you add more 4-note-groups, you must update variable at game start below
int start_note = -4; // start note, so we can quickly go to different groups in the array
                    // add 4 to this and you can skip to next 4-note-group
                    // 3/2/2016 PGL, changing this to "-4", so that we start at the beginning of array when we add 4 the first time.
int instrument = 0;         

#define PLAYBACK_SPEED 600
int playback_speed = PLAYBACK_SPEED; // 150 is standard, but slowing it down makes it easier.
                                      // Note, this is reset each tiem a new game starts, so it has to be an int set by a define
int attract_mode_speed = 150;

int global_static_timeout_count; // this climbs as we see no jumping at all (people have stopped jumping)
#define GLOBAL_STATIC_TIMEOUT_LIMIT 1000 // about 10 seconds

void setup()
{
  //Setup hardware inputs/outputs. These pins are defined in the hardware_versions header file

  //Enable pull ups on inputs
//  pinMode(BUTTON_RED, INPUT_PULLUP);
//  pinMode(BUTTON_GREEN, INPUT_PULLUP);
//  pinMode(BUTTON_BLUE, INPUT_PULLUP);
//  pinMode(BUTTON_YELLOW, INPUT_PULLUP);

// button LEDs aka mode leds
for(int i = 0 ; i < 3 ; i++ )
{
  pinMode(button_leds[i], OUTPUT);
  digitalWrite(button_leds[i], LOW);
}

  pinMode(LED_RED, OUTPUT);
  pinMode(LED_GREEN, OUTPUT);
  pinMode(LED_BLUE, OUTPUT);
  pinMode(LED_YELLOW, OUTPUT);

// ULTRA_SONIC RANGE FINDER SETUP STUFF
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  pinMode(echoPin2, INPUT);
  pinMode(echoPin3, INPUT);
  pinMode(echoPin4, INPUT);  

  if(debug){
    Serial.begin(115200);
    Serial.println("Simon Says Debug ON"); 
  }

  // midi setup
  if(midi)
  {
    //Setup soft serial for MIDI control
    mySerial.begin(31250);
    //Reset the VS1053
    pinMode(resetMIDI, OUTPUT);
    digitalWrite(resetMIDI, LOW);
    delay(100);
    digitalWrite(resetMIDI, HIGH);
    delay(100);
    newGameMelody();
  }

//while(1) play_musical_inst();
//while(1) light_test();
//while(1) mode_button_calibration();
//while(1) if(Serial.available() > 0) exe_serial_command();


}

void loop()
{
  //attractMode(); // Blink lights while waiting for user to press a button
  playback_speed = PLAYBACK_SPEED;
  RED_seq_count = 0;
  GREEN_seq_count = 0;
  BLUE_seq_count = 0;
  YELLOW_seq_count = 0;

  // Indicate the start of game play
  //while(check_mode_buttons() == false); // wait for a button press

  
  newGameMelody(); // indicate new game starting via melodic sound
  setLEDs(CHOICE_RED | CHOICE_GREEN | CHOICE_BLUE); // Turn all LEDs on
  delay(1000);
  setLEDs(CHOICE_OFF); // Turn off LEDs
  if(trampoline) delay(1000);
  else delay(250);
  
  // cycling through each 4-note-group
  if(start_note < 16) start_note += 4;   // Note, you must adjust the "greater than number" when adding more groups.
  else start_note = 0; // reset

    if(debug) Serial.print("rounds to win=");
    if(debug) Serial.println(ROUNDS_TO_WIN);
    if(debug) Serial.print("gameMode=");
    if(debug) Serial.println(gameMode);

  if (gameMode == MODE_MEMORY)
  {
    Serial.println("--->>> Memory Mode");
    set_button_leds();
    // Play memory game and handle result
    if (play_memory() == true) 
    {
      win_melody();
    }
    else 
    {
      if(gameMode == MODE_MEMORY) play_loser(); // Player lost, play loser tones
    }
    //gameMode = MODE_MUSICAL_INST; // DO NOT change mode, so we get another round (unless global timeout happens)
    delay(1000);
  }
  
  if (gameMode == MODE_MUSICAL_INST)
  {
    Serial.println("--->>> Free Jump Mode");
    set_button_leds();
    play_musical_inst(); // Play musical inst until a timeout occurs (3 seconds)
  }
  
  if (gameMode == MODE_WACK_A_MOLE)
  {
    Serial.println("--->>> WACK A MOLE Mode");
    set_button_leds();
    if (play_wack_a_mole() == true)
    {
      win_melody();
    }
    else
    {
      // NO LOSER SOUNDS IN WACK_A_MOLE
      // If we got here, that means that it timed out (no jumping at all for 10 seconds)
      //if(gameMode == MODE_WACK_A_MOLE) play_loser(); // Player lost, play loser tones ***Keeping for reference***
    }
    gameMode = MODE_MUSICAL_INST;
    delay(1000);  
  }
  
  if(global_static_timeout_count > GLOBAL_STATIC_TIMEOUT_LIMIT)
  {
    Serial.println("Global static timeout");
    global_static_timeout_count = 0; // reset
    gameMode = MODE_MUSICAL_INST;
    set_button_leds();
    delay(1000);
  }  
  
}

//-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=
//The following functions are related to game play only

// Wait for a button to be pressed. 
// Returns one of LED colors (LED_RED, etc.) if successful, 0 if timed out
byte wait_for_button(byte currentMove = 0, byte currentMode = MODE_MUSICAL_INST)
{
  long startTime = millis(); // Remember the time we started the this loop

  // reset trampoline variables, to avoid false jumps, (in case someone jumped during playback)
  // This will require a "fresh" jump after playback.
  HIGH_COUNTER_RED = 0;
  HIGH_COUNTER_GREEN = 0;
  HIGH_COUNTER_BLUE = 0;
  HIGH_COUNTER_YELLOW = 0;

  while ( (millis() - startTime) < ENTRY_TIME_LIMIT) // Loop until too much time has passed
  {
    byte button = checkButton_trampoline();
    if(gameMode == MODE_WACK_A_MOLE) 
    {
      startTime = millis(); // negates timeout on this while loop, timeouts in WACK_A_MOLE are handled with global_static_timeout_count (which is incremented and cleared in checkButton_Trampoline
      if(global_static_timeout_count > GLOBAL_STATIC_TIMEOUT_LIMIT) startTime = ENTRY_TIME_LIMIT; // get us out of here
    }

    if(gameMode != currentMode) break; // this means that a mode button was pressed and it's time to break out of here. (this global variable is changed every time we read a trampoline - a lot!

    if (button != CHOICE_NONE)
    { 
      if(currentMode != MODE_WACK_A_MOLE) toner(button, 150); // Play the button the user just pressed, works for memory game, but not for wack a mole
      
      if(trampoline == false) while(checkButton() != CHOICE_NONE) ;  // Now let's wait for user to release button, works fine in standard playing with buttons.
      
      //delay(250); // This helps with debouncing and accidental double taps

      if(currentMode != MODE_WACK_A_MOLE) return button; // as it originally was, works for memory game, but not for wack a mole
      else
      {
        // this means we are in WACK_A_MOLE, and we want to allow the players to jump wrong trampolines, they can just keep jumping until timeout, or they get the correct trampoline
        if(currentMove == button) 
        {
          talkMIDI(0xB0, 0, 0x78); //Bank select drums
          talkMIDI(0xC0, instrument, 0x20); //Set instrument number. 0xC0 is a 1 data byte command
          noteOn(0, 65, 127); // play low "hit a mole sound"
          delay(100);
          talkMIDI(0xB0, 0, bank); //Bank select GM
          talkMIDI(0xC0, instrument, 0x20);
          return button; // in wack a mole, I am sending in currentMove so I can know what I'm looking for as a correct jump
                          // if it's correct, then return it, if not, then do nothing and let timeout take us out
        }      
                                                
      }
    }

  }

  return CHOICE_NONE; // If we get here, we've timed out!
}


// Play the regular memory game
// Returns 0 if player loses, or 1 if player wins
boolean play_memory(void)
{
  randomSeed(millis()); // Seed the random generator with random amount of millis()

  gameRound = 0; // Reset the game to the beginning

  while (gameRound < ROUNDS_TO_WIN) 
  {
    add_to_moves(); // Add a button to the current moves, then play them back

    playMoves(); // Play back the current game board

    // Then require the player to repeat the sequence.
    for (byte currentMove = 0 ; currentMove < gameRound ; currentMove++)
    {
      
      byte choice = wait_for_button(0, MODE_MEMORY); // See what button the user presses
      
      if (choice == 0) return false; // If wait timed out, player loses

      if (choice != gameBoard[currentMove]) return false; // If the choice is incorect, player loses
    }

    // delay 2000 ms with polling for mode buttons, note, this used to be just a delay, but I want to be able to jump out if a mode button is pressed.
    // delay(2000); // Player was correct, delay before playing moves
    for(int i = 0 ; i < 2000 ; i++)
    {
      delay(1);
      check_mode_buttons();
      if(gameMode != MODE_MEMORY) break; // this means that a mode button was pressed and it's time to break out of here. (this global variable is changed every time we read a trampoline - a lot!
    }
    
  }

  return true; // Player made it through all the rounds to win!
}

// Play the special 2 player battle mode
// A player begins by pressing a button then handing it to the other player
// That player repeats the button and adds one, then passes back.
// This function returns when someone loses
boolean play_battle(void)
{
  gameRound = 0; // Reset the game frame back to one frame
  
  while (1) // Loop until someone fails 
  {
    byte newButton = wait_for_button(0, MODE_BATTLE); // Wait for user to input next move
    gameBoard[gameRound++] = newButton; // Add this new button to the game array

    // Then require the player to repeat the sequence.
    for (byte currentMove = 0 ; currentMove < gameRound ; currentMove++)
    {
      byte choice = wait_for_button(0, MODE_BATTLE);

      if (choice == 0) return false; // If wait timed out, player loses.

      if (choice != gameBoard[currentMove]) return false; // If the choice is incorect, player loses.
    }

    delay(100); // Give the user an extra 100ms to hand the game to the other player
  }

  return true; // We should never get here
}

// Plays the current contents of the game moves
void playMoves(void)
{
  for (byte currentMove = 0 ; currentMove < gameRound ; currentMove++) 
  {
    if(gameMode != MODE_MEMORY) break; // this means that a mode button was pressed and it's time to break out of here. (this global variable is changed every time we read a trampoline - a lot!
    // Pete Lewis 3/2/2016, decrease playback_speed as the sequence gets longer
    // To win you get to 13, so let's shoot for 1/2 of playback speed by the time you get to 13 steps,
    // this means we need to cut 1/2 of playback speed over 13 rounds
    int subtraction = playback_speed * 0.15;
    subtraction /= ROUNDS_TO_WIN; // 
    subtraction *= currentMove; // depending on where we are in the sequence, the larger this "subtraction" will be, making it faster.
    playback_speed -= subtraction;
    toner(gameBoard[currentMove], playback_speed);

    // Wait some amount of time between button playback
    // Shorten this to make game harder
    if(currentMove != (gameRound-1)) delay(playback_speed); // 150 works well. 75 gets fast.
                                                        // also note, if on the last one, don't delay,
                                                        // this allows the player to jump right into user input... no punn intended haha.
  }
}

// Adds a new random button to the game sequence
void add_to_moves(void)
{
  byte newButton = random(0, 3); //min (included), max (exluded)

  // ensure we don't repeat a button more than two times in a row - add to the while loop below, if you want more repeats possible.
  if(gameRound > 1) // only after you make it to step 3.
  {
      // attempt 1, works.
      // while((newButton == gameBoard[gameRound-1]) && (newButton == gameBoard[gameRound-2])) newButton = random(0, 4); // keep pulling in more variables until this isn't true.
      // basically, if it's the same as the previous 2 buttons, then it will keep finding a random number until it's "fresh".

      // attempt 2, attempting to add in limit per button to avoid leaving one jumper out.
    while(1)
    {
      newButton = random(0, 3);
      if(!((newButton == gameBoard[gameRound-1]))) // This ensures it's not going to repeat same button 3 times
      {
        // check to see if that button is already "maxed out" (aka it has been used twice already)
        if((newButton == 0) && (RED_seq_count == 2)); // do nothing
        else if((newButton == 1) && (GREEN_seq_count == 3)); // do nothing
        else if((newButton == 2) && (BLUE_seq_count == 3)); // do nothing
        //else if((newButton == 3) && (YELLOW_seq_count == 2)); // do nothing
        else break; // get out of this while loop and continue playing. This means that the new button is good to go. 
      }    
    }
  }
  
  // We have to convert this number, 0 to 3, to CHOICEs
  if(newButton == 0) 
  {
    newButton = CHOICE_RED;
    RED_seq_count++;
  }
  else if(newButton == 1) 
  {
    newButton = CHOICE_GREEN;
    GREEN_seq_count++;
  }
  else if(newButton == 2) 
  {
    newButton = CHOICE_BLUE;
    BLUE_seq_count++;
  }
  else if(newButton == 3) 
  {
    newButton = CHOICE_YELLOW;
    YELLOW_seq_count++;
  }

  gameBoard[gameRound++] = newButton; // Add this new button to the game array
}

//-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=
//The following functions control the hardware

// Lights a given LEDs
// Pass in a byte that is made up from CHOICE_RED, CHOICE_YELLOW, etc
void setLEDs(byte leds)
{
  if ((leds & CHOICE_RED) != 0)
    digitalWrite(LED_RED, HIGH);
  else
    digitalWrite(LED_RED, LOW);

  if ((leds & CHOICE_GREEN) != 0)
    digitalWrite(LED_GREEN, HIGH);
  else
    digitalWrite(LED_GREEN, LOW);

  if ((leds & CHOICE_BLUE) != 0)
    digitalWrite(LED_BLUE, HIGH);
  else
    digitalWrite(LED_BLUE, LOW);

  if ((leds & CHOICE_YELLOW) != 0)
    digitalWrite(LED_YELLOW, HIGH);
  else
    digitalWrite(LED_YELLOW, LOW);
}



// play_musical_inst()
// This mode allows the user to simply press buttons and see LED light up and hear the sound
// if it times out, then it returns false and this will
// take you back to the very beginning of the main loop.

void play_musical_inst(void)
{
  Serial.println("--FREE JUMP--");
  while (gameMode == MODE_MUSICAL_INST) // Loop until we switched modes (happens in checkButton_Trampoline, MODE can change every time we call readDistance() - which happens a ton all the time!!!
  {
    checkButton_trampoline();
  }
}

// Returns a '1' bit in the position corresponding to CHOICE_RED, CHOICE_GREEN, etc.
byte checkButton(void)
{
  if (digitalRead(BUTTON_RED) == 0) return(CHOICE_RED); 
  else if (digitalRead(BUTTON_GREEN) == 0) return(CHOICE_GREEN); 
  else if (digitalRead(BUTTON_BLUE) == 0) return(CHOICE_BLUE); 
  else if (digitalRead(BUTTON_YELLOW) == 0) return(CHOICE_YELLOW);
  
  return(CHOICE_NONE); // If no button is pressed, return none
}

// Returns a '1' bit in the position corresponding to CHOICE_RED, CHOICE_GREEN, etc.
// but the FLAG of that button must have been set to

byte checkButton_trampoline(void)
{
  byte CHOICE = CHOICE_NONE; // if nothing is pressed
  byte CHOICE_LEDS_COMBO = 0; // start with no LEDs on (if there is no jumping), then we will "and" them all in, so you can have multiples light up at the same time.
  start_note = 0; // reset to use the first 4 notes in the array - note won't change at MOB installation
  //ultra_sonic_test();
  //digitalReadTrampoline_test();
  read_T_distances();
  set_T_booleans();
  print_data();
  /////////////////RED
  if ((T_boolean[0] == 0) && (HIGH_COUNTER_RED > 5)) // if FLAG_RED is set to true, that means that it has been release at some point previously.
  {
    HIGH_COUNTER_RED = 0; // reset counter
    if(gameMode != MODE_WACK_A_MOLE) noteOn(0, notes[start_note], 127); // start note, so we can quickly go to different groups in the array
    CHOICE_LEDS_COMBO |= CHOICE_RED;
    CHOICE = CHOICE_RED;
    //return(CHOICE_RED);
  }

  /////////////////GREEN
  if ((T_boolean[1] == 0) && (HIGH_COUNTER_GREEN > 5)) // if FLAG_RED is set to true, that means that it has been release at some point previously.
  {
    HIGH_COUNTER_GREEN = 0; // reset counter
    if(gameMode != MODE_WACK_A_MOLE) noteOn(0, notes[start_note+1], 127); // start_note+1 to get the next spot in 4-note-group    
    CHOICE_LEDS_COMBO |= CHOICE_GREEN;
    CHOICE = CHOICE_GREEN;
    //return(CHOICE_GREEN);
  }

  /////////////////BLUE
  if ((T_boolean[2] == 0) && (HIGH_COUNTER_BLUE > 5)) // if FLAG_RED is set to true, that means that it has been release at some point previously.
  {
    HIGH_COUNTER_BLUE = 0; // reset counter
    if(gameMode != MODE_WACK_A_MOLE) noteOn(0, notes[start_note+2], 127); // start_note+2 to get the next spot in 4-note-group    
    CHOICE_LEDS_COMBO |= CHOICE_BLUE;
    CHOICE = CHOICE_BLUE;
   // return(CHOICE_BLUE);
  }

//  /////////////////YELLOW
//  if ((T_boolean[3] == 0) && (HIGH_COUNTER_YELLOW > 5)) // if FLAG_RED is set to true, that means that it has been release at some point previously.
//  {
//    HIGH_COUNTER_YELLOW = 0; // reset counter
//    noteOn(0, notes[start_note+3], 127); // start_note+3 to get the next spot in 4-note-group   
//    CHOICE_LEDS_COMBO |= CHOICE_YELLOW;
//    CHOICE = CHOICE_YELLOW; 
//    //return(CHOICE_YELLOW);
//  }
  
  if((T_boolean[0] == 1) && (HIGH_COUNTER_RED < 6)) HIGH_COUNTER_RED++;
  if((T_boolean[1] == 1) && (HIGH_COUNTER_GREEN < 6)) HIGH_COUNTER_GREEN++;
  if((T_boolean[2] == 1) && (HIGH_COUNTER_BLUE < 6)) HIGH_COUNTER_BLUE++;
//  if((T_boolean[3] == 1) && (HIGH_COUNTER_YELLOW < 6)) HIGH_COUNTER_YELLOW++;

  if(gameMode != MODE_WACK_A_MOLE) setLEDs(CHOICE_LEDS_COMBO);
  
  //GLOBAL STATIC TIMEOUT STUFF ////////////////////////////////////////////
  if((CHOICE == CHOICE_NONE) && (gameMode != MODE_MUSICAL_INST)) global_static_timeout_count++; // keep count
  else global_static_timeout_count = 0; // reset
  //Serial.println(global_static_timeout_count);
  
  return(CHOICE); // If no button is pressed, this will be default CHOICE_NONE, but if something is pressed, then it will be set in the IFs above.
}

// Light an LED and play tone
// Red, upper left:     440Hz - 2.272ms - 1.136ms pulse
// Green, upper right:  880Hz - 1.136ms - 0.568ms pulse
// Blue, lower left:    587.33Hz - 1.702ms - 0.851ms pulse
// Yellow, lower right: 784Hz - 1.276ms - 0.638ms pulse
void toner(byte which, int buzz_length_ms)
{
  setLEDs(which); //Turn on a given LED
start_note = 0; // reset to use the first 4 notes in the array - note won't change at MOB installation
  //Play the sound associated with the given LED
  switch(which) 
  {
  case CHOICE_RED:
   // Serial.println("RED");
    if(midi){
      talkMIDI(0xB0, 0, bank); //Bank select drums
      talkMIDI(0xC0, instrument, 0x20); //Set instrument number. 0xC0 is a 1 data byte command
      noteOn(0, notes[start_note], 127); // start note, so we can quickly go to different groups in the array
    }
//    buzz_sound(buzz_length_ms, 1136); 
    break;
  case CHOICE_GREEN:
    if(midi){
      talkMIDI(0xB0, 0, bank); //Bank select drums
      talkMIDI(0xC0, instrument, 0x20); //Set instrument number. 0xC0 is a 1 data byte command
      noteOn(0, notes[start_note+1], 127); // start_note+1 to get the next spot in 4-note-group
    }
//    buzz_sound(buzz_length_ms, 568); 
    break;
  case CHOICE_BLUE:
    if(midi){
      talkMIDI(0xB0, 0, bank); //Bank select drums
      talkMIDI(0xC0, instrument, 0x20); //Set instrument number. 0xC0 is a 1 data byte command
      noteOn(0, notes[start_note+2], 127); // start_note+2 to get the next spot in 4-note-group
    }
//    buzz_sound(buzz_length_ms, 851); 
    break;
  case CHOICE_YELLOW:
    if(midi){
      talkMIDI(0xB0, 0, bank); //Bank select drums
      talkMIDI(0xC0, instrument, 0x20); //Set instrument number. 0xC0 is a 1 data byte command
      noteOn(0, notes[start_note+3], 127); // start_note+3 to get the next spot in 4-note-group
    }
//    buzz_sound(buzz_length_ms, 638); 
    break;
  }
  delay(100);
  setLEDs(CHOICE_OFF); // Turn off all LEDs
}


// Play the loser sound/lights
void play_loser(void)
{
  if((gameMode == MODE_MEMORY) || (gameMode == MODE_WACK_A_MOLE)) // only do this, if we are still in memory mode, note, we could have got here from a mode button press, and we're just switching modes, to no need to play loser.
  {
    setLEDs(CHOICE_RED | CHOICE_GREEN);
    talkMIDI(0xB0, 0, 0x78); //Bank select drums
    talkMIDI(0xC0, instrument, 0x20); //Set instrument number. 0xC0 is a 1 data byte command
    noteOn(0, 38, 127); // snaire
    delay(100);
    noteOn(0, 50, 127); // High Tom
    noteOn(0, 72, 127); // whistle  
  //  buzz_sound(255, 1500);
    
    setLEDs(CHOICE_BLUE | CHOICE_YELLOW);
    noteOn(0, 38, 127); // snaire
    delay(100);  
    noteOn(0, 45, 127); // Low Tom
  //  buzz_sound(255, 1500);
  
    setLEDs(CHOICE_RED | CHOICE_GREEN);
    noteOn(0, 38, 127); // snaire
    delay(100);  
    noteOn(0, 50, 127); // High Tom  
  //  buzz_sound(255, 1500);
  
    setLEDs(CHOICE_BLUE | CHOICE_YELLOW);
    noteOn(0, 38, 127); // snaire
    delay(100);  
    noteOn(0, 45, 127); // Low Tom  
    noteOn(0, 49, 127); // crash
    noteOn(0, 86, 127); // kick
    noteOn(0, 38, 127); // snaire
    noteOn(0, 58, 127); // clacker 
  //  buzz_sound(255, 1500);
    talkMIDI(0xB0, 0, bank); //Bank select GM
    talkMIDI(0xC0, instrument, 0x20); //Set instrument number. 0xC0 is a 1 data byte command
  }
}

// Show an "attract mode" display while waiting for user to press button.
void attractMode(void)
{
  Serial.println("Attract Mode");
  long counter = 0;
  //if(trampoline) attract_mode_speed *= 10;
  long attract_start_time = millis();
  long attract_timeout = millis(); // this will be used to go back to FREE JUMP if left in some other mode (and attract) for too long.
  attract_mode_bool = true;
  while(attract_mode_bool) 
  {
    if(Serial.available()) exe_serial_command();
    else{
      if(trampoline)
      {

        //Serial.println(checkButton_trampoline());
        if(check_mode_buttons() == true) return;
        if((gameMode != MODE_MUSICAL_INST) && ((millis() - attract_timeout) == 10000))
        {
          Serial.println("attract_mode_timeout - switching to musical instrument mode");
          gameMode = MODE_MUSICAL_INST;
          attract_mode_bool = false;
        }
        //Serial.println(check_mode_buttons());
        if((millis() - attract_start_time) == 1000) setLEDs(CHOICE_RED);
        else if((millis() - attract_start_time) == 2000) setLEDs(CHOICE_BLUE);
        else if((millis() - attract_start_time) == 3000) 
        {
          setLEDs(CHOICE_GREEN);
          attract_start_time = millis(); // reset timer
        }
        
//        if(checkButton_trampoline() != CHOICE_NONE) 
//        {
//          Serial.println("not choice_none");
//          attract_mode_bool = false;
//          return;
//        }
//        else 
//        {
//          Serial.println("choice_none");
//        }
      }
      else{
        setLEDs(CHOICE_RED);
        delay(attract_mode_speed);
        if (checkButton() != CHOICE_NONE) return;
    
        setLEDs(CHOICE_BLUE);
        delay(attract_mode_speed);
        if (checkButton() != CHOICE_NONE) return;
    
        setLEDs(CHOICE_GREEN);
        delay(attract_mode_speed);
        if (checkButton() != CHOICE_NONE) return;
    
        setLEDs(CHOICE_YELLOW);
        delay(attract_mode_speed);
        if (checkButton() != CHOICE_NONE) return;
      }
    }
  }
}

void light_test(void)
{
  pinMode(A2, OUTPUT);
  pinMode(A3, OUTPUT);
  pinMode(A4, OUTPUT);
  pinMode(A5, OUTPUT);

  
  
  digitalWrite(A2, HIGH);
//  digitalWrite(A3, HIGH);
//  digitalWrite(A4, HIGH);
//  digitalWrite(A5, HIGH);
  delay(1000);


  digitalWrite(A2, LOW);
  digitalWrite(A3, LOW);
  digitalWrite(A4, LOW);
  digitalWrite(A5, LOW);
  delay(1000);
}

boolean check_mode_buttons()
{
  mode_ADC_reading = analogRead(A7);
  if(mode_ADC_reading > 900) return false; // no button being pressed
  else
  {
    Serial.println(mode_ADC_reading);
    // take some more readings and average them, to avoid false button presses.
    // this requires that the button be held down a little more solidly
    int total_readings = 0;
    for (int i = 0 ; i < 10 ; i++)
    {
      total_readings += analogRead(A7);
      delay(10);
    }
    mode_ADC_reading = (total_readings/10);
    Serial.println(mode_ADC_reading);
      if((mode_ADC_reading > (button_value[0] - 5)) && (mode_ADC_reading < (button_value[0] + 5)))
      {
        gameMode = MODE_MEMORY;
        Serial.println("MEMORY");
        set_button_leds();
        return true;
      }
      
      else if((mode_ADC_reading > (button_value[1] - 5)) && (mode_ADC_reading < (button_value[1] + 5)))
      {
        gameMode = MODE_WACK_A_MOLE;
        Serial.println("WACK-A-MOLE");
        set_button_leds();
        return true;
      }
      
      else if((mode_ADC_reading > (button_value[2] - 5)) && (mode_ADC_reading < (button_value[2] + 5)))
      {
        gameMode = MODE_MUSICAL_INST;
        Serial.println("FREE JUMP");
        set_button_leds();
        return true;
      }
      else
      {
        Serial.println("BAD VALUE");
        return false;
      }
  }
}

void mode_button_calibration()
{
  Serial.println(analogRead(A7));
  delay(50);
  /*
   * 
   * These are the readings I'm seeing on my first MAIN board built up.
   * open: 1023
   * B1: 90
   * B2: 168
   * B3: 234
   * B4: 290
   * B5: 339
   * B6: 381
   * B7: 419
   */
}

// Play the Wack a Mole game
// Returns 0 if player loses, or 1 if player wins
boolean play_wack_a_mole(void)
{
  newGameMelody();
  Serial.println("Wack-a-mole starting now...");
  delay(1000);
  // choose a random trampoline
  // light up the LED - keep it on.
  // listen for the player to jump on that trampoline
  // once they jump on that trampoline, turn off the LED and play the wack sound (low pitched tone).
  // if the player does not hit the correct trampoline, timeout to play loser(), then go to free jump.
  // keep a count of successful wacks, if they get to 10, then play winner, then go back to free jump.

  start_note = 0; // reset to use the first 4 notes in the array - note won't change at MOB installation

  randomSeed(millis()); // Seed the random generator with random amount of millis()

  byte successful_wacks = 0; // Reset the game to the beginning
  byte previous_button = 0; // to avoid too many repeats
  byte newButton = 0; // start here, then we randomly go in either direction.
  while ((successful_wacks < 20) && (gameMode == MODE_WACK_A_MOLE)) 
  {
    // try and make the sequences a little less repeatative
    RED_seq_count = 0;
    GREEN_seq_count = 0;
    BLUE_seq_count = 0;
    while(1)
    {
      newButton = random(0, 3);
      if(newButton != previous_button) // This ensures it's not going to repeat same button 3 times
      {
        // check to see if that button is already "maxed out" (aka it has been used twice already)
        if((newButton == 0) && (RED_seq_count == 4)); // do nothing
        else if((newButton == 1) && (GREEN_seq_count == 3)); // do nothing
        else if((newButton == 2) && (BLUE_seq_count == 3)); // do nothing
        else break; // get out of this while loop and continue playing. This means that the new button is good to go. 
      }    
    }
      Serial.print("previous_button:");
      Serial.println(previous_button);
      Serial.print("newButton:");
      Serial.println(newButton);
      previous_button = newButton; // to keep track of this thing

  // We have to convert this number, 0 to 3, to CHOICEs
  if(newButton == 0) 
  {
    newButton = CHOICE_RED;
    noteOn(0, notes[start_note], 127); // start note, so we can quickly go to different groups in the array
    setLEDs(CHOICE_RED);
    RED_seq_count++;
  }
  else if(newButton == 1) 
  {
    newButton = CHOICE_GREEN;
    noteOn(0, notes[start_note+1], 127); // start note, so we can quickly go to different groups in the array 
    setLEDs(CHOICE_GREEN);   
    GREEN_seq_count++;
  }
  else if(newButton == 2) 
  {
    newButton = CHOICE_BLUE;
    noteOn(0, notes[start_note+2], 127); // start note, so we can quickly go to different groups in the array   
    setLEDs(CHOICE_BLUE); 
    BLUE_seq_count++;
  }

  Serial.print("Wack chosen:");
  Serial.println(newButton);
  //delay(1000);
  // Then require the player to repeat the chosen bounce.
  byte choice = wait_for_button(newButton, MODE_WACK_A_MOLE); // See what button the user presses, send it currentMove (correct), so I can wait for that

  Serial.print("user choice:");
  Serial.println(choice);
  
  //if (choice == 0) return false; // If wait timed out, player loses
  
  if (choice == newButton) 
  {
    setLEDs(CHOICE_NONE);
    successful_wacks++; // If the choice is correct, increment successful wacks and let this while loop continue gameplay
    Serial.print("successful wacks:");
    Serial.println(successful_wacks);
    if(successful_wacks == 19) 
    {
      delay(500);
      win_melody(); // they won!!
      successful_wacks = 0; // start new round
      delay(1000);
      //return true; // DO NOT RETURN, because we want another round to keep going.
    }
    //delay(1000);    
  }
  else if(global_static_timeout_count > GLOBAL_STATIC_TIMEOUT_LIMIT)
  {
    Serial.println("Global static timeout");
    global_static_timeout_count = 0; // reset
    gameMode = MODE_MUSICAL_INST;
    set_button_leds();
    return false; // if incorrect, then return false and get us out of here back to the main loop.
  }

    // delay 2000 ms with polling for mode buttons, note, this used to be just a delay, but I want to be able to jump out if a mode button is pressed.
    // delay(2000); // Player was correct, delay a random amount before showing next mole
    int wait_time = random(250,1000);
    for(int i = 0 ; i < wait_time ; i++)
    {
      delay(1);
      check_mode_buttons();
      if(gameMode != MODE_WACK_A_MOLE) break; // this means that a mode button was pressed and it's time to break out of here. (this global variable is changed every time we read a trampoline - a lot!
    }
  }
}

void set_button_leds(void)
{
  int select;
  for(int i = 0 ; i < 3 ; i++ ) 
  {
    digitalWrite(button_leds[i], LOW);
  }
  
  if(gameMode == MODE_MEMORY) select = 0;
  else if(gameMode == MODE_WACK_A_MOLE) select = 1;
  else if(gameMode == MODE_MUSICAL_INST) select = 2;
  
  digitalWrite(button_leds[select], HIGH);
}