#include <SoftwareSerial.h> // reassignment of serial ports away from Arduino's pin 0, 1.

SoftwareSerial Bluetooth(5, 6); // RX, TX for Bluetooth HC05

// FOR ACCELEROMETER //
const int xpin = A0; // x-axis 
const int ypin = A1; // y-axis

// FOR FLEX SENSORS //
int flexsensorPin1  = A2; // Flex Sensor 1
int flexsensorPin2  = A3; // Flex Sensor 2

// FOR BUTTON & LED //
#define button 2 // pin 2 for button read
#define redLED 11 // pin 11 for red led
#define greenLED 10 // pin 10 for green led
#define blueLED 9 // pin 9 for blue led
int state = 0;
int old = 0;
int buttonPoll = 0;

void setup() 
{
    // Open serial port //
     Serial.begin(9600);                       
    
    // begin bluetooth serial port communication //
    Bluetooth.begin(9600);

    //setup LED
    pinMode(button,INPUT);
    //RGB LED set as output
    pinMode(redLED,OUTPUT);
    pinMode(greenLED,OUTPUT);
    pinMode(blueLED,OUTPUT);

    digitalWrite(redLED,LOW);
    digitalWrite(greenLED,LOW);
    digitalWrite(blueLED,LOW);
    
}


void loop() // Now for the loop
{
    // FOR ACCELEROMETER //
    int x = analogRead(xpin); //read from xpin for accel
    delay(1); //
    int y = analogRead(ypin); //read from ypin for accel
    delay(1); //
    
    // FOR FLEX SENSOR //
    int flex1 = analogRead(flexsensorPin1);
    delay(1);
    int flex2 = analogRead(flexsensorPin2);
    delay(1);

    // FOR BUTTON & LED //
    buttonPoll = digitalRead(button);
    if(buttonPoll == 1) 
    {   
       delay(150);
       buttonPoll = digitalRead(button);
       if(buttonPoll == 0) 
         {
           state = old + 1;
         }
    }
    
    else 
    {
       delay(10);
    }

    switch (state) 
    {  
       default:
       digitalWrite(redLED,HIGH);
       digitalWrite(greenLED,HIGH);
       digitalWrite(blueLED,HIGH);
       old = 0;
       break;
      
       case 1: //White color
       digitalWrite(redLED,LOW);
       digitalWrite(greenLED,LOW);
       digitalWrite(blueLED,LOW);
       old = state; 
       break;
      
       case 2: //Green color
       digitalWrite(redLED,HIGH);
       digitalWrite(greenLED,LOW);
       digitalWrite(blueLED,HIGH);
       old = state;
       break;
      
       case 3: //Blue color
       digitalWrite(redLED,HIGH);
       digitalWrite(greenLED,HIGH);
       digitalWrite(blueLED,LOW);
       old = state; 
       break;
      
       case 4: //Purple color
       digitalWrite(redLED,LOW);
       digitalWrite(greenLED,HIGH);
       digitalWrite(blueLED,LOW);
       old = state; 
       break;

    }   
      // FOR PRINTING TO SERIAL VIA REASSIGNED RX(5) TX(6), NAMED "Bluetooth" //
       Bluetooth.print(x); //print x value on bluetooth serial
       Bluetooth.print(" ");
       Bluetooth.print(y); //print y value on bluetooth serial
       Bluetooth.print(" ");
       Bluetooth.print(old);
       Bluetooth.print(" ");
       Bluetooth.print(flex1);
       Bluetooth.print(" ");
       Bluetooth.print(flex2);
       Bluetooth.println(" ");
       
       delay(20);

        /*
          Serial.print(x);
          Serial.print(" ");
          Serial.print(y);
          Serial.print(" ");
          Serial.print(old);
          Serial.print(" ");
          Serial.print(flex1);
          Serial.print(" ");
          Serial.print(flex2);
          Serial.println ("\n");
          delay(10);
        */

}