//www.elegoo.com
//2016.12.08

#include "Wire.h" // This library allows you to communicate with I2C devices.
const int MPU_ADDR = 0x68; // I2C address of the MPU-6050. If AD0 pin is set to HIGH, the I2C address will be 0x69.
int16_t accelerometer_x, accelerometer_y, accelerometer_z; // variables for accelerometer raw data
int16_t gyro_x, gyro_y, gyro_z; // variables for gyro raw data
int16_t temperature; // variables for temperature data
char tmp_str[7]; // temporary variable used in convert function
char* convert_int16_to_str(int16_t i) { // converts int16 to string. Moreover, resulting strings will have the same length in the debug monitor.
  sprintf(tmp_str, "%6d", i);
  return tmp_str;
}
//int redPin = 5;
//int greenPin= 6;
//int buttonOnpin = 9;
//int buttonOffpin = 8;

int redPin = 11;
int greenPin= 8;
int buttonOnpin = 2;
int buttonOffpin = 3;


boolean isOn = false;
unsigned long previousMillis = 0;
const long interval = 1000;

byte leds = 0;

void setup()
{
  pinMode(redPin, OUTPUT);
  pinMode(greenPin, OUTPUT);
  pinMode(buttonOnpin, INPUT_PULLUP);
  pinMode(buttonOffpin, INPUT_PULLUP);
  Serial.begin(9600);
  Wire.begin();
  Wire.beginTransmission(MPU_ADDR); // Begins a transmission to the I2C slave (GY-521 board)
  Wire.write(0x6B); // PWR_MGMT_1 register
  Wire.write(0); // set to zero (wakes up the MPU-6050)
  Wire.endTransmission(true);
}

void loop()
{
  unsigned long currentMillis = millis();

  if (currentMillis - previousMillis >= interval)
  {
    previousMillis = currentMillis;
  }
  if (digitalRead(buttonOnpin) == LOW and digitalRead(buttonOffpin) == LOW)
  {
    digitalWrite(greenPin, HIGH);
    digitalWrite(greenPin, LOW);
  }

  if (digitalRead(buttonOnpin) == LOW or digitalRead(buttonOffpin) == LOW)
  {
    digitalWrite(redPin, HIGH);
    digitalWrite(redPin, LOW);
  }
}