//*****************************************************************************************************************************************************************************************
//***************************************************************************  Arduino UNO simulator met Java  ****************************************************************************
//*******************************************************************  Copyright by Marc Van Den Berge en Louis D'hont  *******************************************************************
//*****************************************************************************************************************************************************************************************

//#include <SimulatorProgram.h>


//#include <Servo.h>

#define redLedPin 6
#define grLedPin 4
#define onSwitchPin 5
#define offSwitchPin 3
#define trigPin 10
#define echoPin 11
//#define servoPin = 9;

//Servo myServo;

int redLed;
int grLed;
int onSwitch;
int offSwitch;
int trig;
int echo;
unsigned long startMillis = 0;
unsigned long currentMillis;
unsigned long previousMillis;
const long period = 1000;
float duration, distance;
bool switchOn = true;
bool switchOff = false;


void setup() { 
  millis();
  startMillis = millis();
 
  Serial.begin(9600);                           
  
  //inString.reserve(10); 
  //RealIO_Connect();   // Used for connection between arduino and real IO

 //Servo.attach(9);
 
 pinMode(redLedPin, OUTPUT);
 pinMode(grLedPin, OUTPUT);
 pinMode(onSwitchPin, INPUT);
 pinMode(offSwitchPin, INPUT);
 pinMode(trigPin, OUTPUT);
 pinMode(echoPin, INPUT);

digitalWrite(redLedPin, HIGH);
digitalWrite(grLedPin, LOW);
digitalWrite(onSwitchPin, LOW);
digitalWrite(offSwitchPin, HIGH);
digitalWrite(trigPin, LOW);
digitalWrite(echoPin, LOW);

 }
 

 
void loop() { 
  currentMillis = startMillis;
 Serial.println(millis());
 delay(1000);
  if (currentMillis - startMillis <= period){
    digitalWrite(onSwitchPin, HIGH);}
    digitalWrite(offSwitchPin, LOW);
       previousMillis = currentMillis;
    digitalRead(onSwitchPin);
  if (onSwitchPin == HIGH){
    digitalWrite(grLedPin, HIGH);}
    digitalWrite(redLedPin, LOW); 
    currentMillis = previousMillis;
  
  if (currentMillis - previousMillis >= period){
    digitalWrite(trigPin, HIGH);}
    delayMicroseconds(10);
    digitalWrite(trigPin, LOW);
    currentMillis = previousMillis;
  
 /* if (trigPin == LOW){
    pulseIn(echoPin, HIGH);}
    duration = pulseIn(echoPin, HIGH);
    distance = (duration * .034)/2;
      currentMillis = previousMillis;
        Serial.print("Distance:\n");
        Serial.print(distance);*/
}