//Second project for the HTMAA class.
#include <Servo.h>

Servo servo_left;  // create servo object for left servo
Servo servo_right; //create servo object for right servo
#define motion_left 16
#define motion_right 17

int pos = 0;    // variable to store the servo position
float val_left;
float val_right;

void setup() {
  Serial1.begin(115200);
  //Servo Control
  servo_left.attach(0);
  servo_right.attach(1);
  pinMode(motion_left, INPUT);     // declare sensor as input
  pinMode(motion_right, INPUT);     // declare sensor as input
}

void loop() {
  val_left = digitalRead(motion_left);  // read from left motion sensor
  val_right = digitalRead(motion_right); //read from right motion sensor
  if (val_left == HIGH) {            // check if the input from left motion sensor is HIGH
    for (pos = 0; pos <= 90; pos += 1) {
    // in steps of 1 degree
    servo_left.write(pos);
    servo_right.write(pos);
    delay(50); // waits 15ms for the servo to reach the position
    }
    val_left = 0;
  }
  if (val_right == HIGH) {            // check if the input from left motion sensor is HIGH
    for (pos = 0; pos <= 90; pos += 1) {
    // in steps of 1 degree
    servo_left.write(180-pos);
    servo_right.write(180-pos);
    delay(50); // waits 15ms for the servo to reach the position
    }
    val_right = 0;
  }
}