// Arduino Wave Tank II
// vgmlr
#include "Servo.h"
Servo left;
Servo right;
int pos = 20;
int back = 20;
int forward = 160;
int spe = 15;
int red = 6;
int green = 5;
int blue = 4;
void setup() {
  Serial.begin(9600);
  left.attach(2);
  right.attach(3);
  pinMode(red, OUTPUT);
  pinMode(green, OUTPUT);
  pinMode(blue, OUTPUT);
  left.write(back);
  right.write(back);
  digitalWrite(green, HIGH);
  delay(1000);
  digitalWrite(green, LOW);
  delay(1000);
  digitalWrite(red, HIGH);
  delay(1000);
  digitalWrite(red, LOW);
  delay(1000);
}
void loop() {
  int pent = analogRead(A0);
  Serial.println(pent);
  spe = map(pent, 0, 1023, 15, 1);
  if (spe >= 10) {
    digitalWrite(green, HIGH);
    digitalWrite(blue, LOW);
    digitalWrite(red, LOW);
  }
  else if (spe < 10 && spe >= 5) {
    digitalWrite(green, LOW);
    digitalWrite(blue, HIGH);
    digitalWrite(red, LOW);
  }
  else if (spe < 5 && spe >= 1) {
    digitalWrite(green, LOW);
    digitalWrite(blue, LOW);
    digitalWrite(red, HIGH);
  }
  for (pos = back; pos <= forward; pos += 1) {
    left.write(pos);
    right.write(pos);
    delay(spe);
  }
  for (pos = forward; pos >= back; pos -= 1) {
    left.write(pos);
    right.write(pos);
    delay(spe);
  }
}