// Program for attiny1614 to control robot
// created by Jans Hendry
// Universitas Gadjah Mada, Indonesia
// Kamakura Node, Japan
// fab academy MIT - 2022

// variables
const int sigFromesp = 3; // signal from ESP for motor
const int sigFromesp2 = 7; // signal from ESP for LED
const int LED = 9; // pin LED
const int mtr = 8; // pin MOTOR

void setup(){

  // start serial
  Serial.begin(115200);
  
  // setup pins for signaling
  pinMode(sigFromesp, INPUT_PULLUP); // wait signal from ESP32
  pinMode(sigFromesp2, INPUT_PULLUP); // second signal from ESP32
  pinMode(LED, OUTPUT);
  digitalWrite(LED, LOW); // turn off LED
  pinMode(mtr, OUTPUT);
  digitalWrite(mtr, LOW); // off motor
  
  delay(500); // delay 0.5 sec
}

void loop(){

  // Turn ON or OFF LED in ATTINY3216 according to signaling from esp that it 
  // takes from bluetooth connection (Mobile Phone)
  // motor turn
  if (digitalRead(sigFromesp) == HIGH){
    digitalWrite(mtr, HIGH); // ON motor
    delayMicroseconds(10);    
  }
  else if (digitalRead(sigFromesp) == LOW){
    digitalWrite(mtr, LOW); // OFF motor
    delayMicroseconds(10);
  }
  // led turn
  if (digitalRead(sigFromesp2) == HIGH){
    digitalWrite(LED, HIGH); // ON led
    delayMicroseconds(10);
  }
  else if (digitalRead(sigFromesp2) == LOW){
    digitalWrite(LED, LOW); // OFF led
    delayMicroseconds(10);    
  }
}