// Arduino Wave Tank

// TVMiller

#include <Servo.h>

Servo left;

Servo right;

int pos = 20;

int post = 160;

int back = 20;

int forward = 160;

int red = 6;

int green = 5;

int blue = 4;

int slow = 8;

int fast = 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);

if (pent < 200) {

digitalWrite(blue, HIGH);

digitalWrite(red, LOW);

digitalWrite(green, LOW);

for (pos = back; pos <= forward; pos += 1) {

left.write(pos);

right.write(pos);

delay(slow);
 }

for (pos = forward; pos >= back; pos -= 1) {

left.write(pos);

right.write(pos);

delay(slow);

else if (pent > 200 && pent < 450) {

digitalWrite(blue, LOW);

digitalWrite(red, HIGH);

digitalWrite(green, LOW);

for (pos = back; pos <= forward; pos += 1) {

left.write(pos);

right.write(pos);

delay(fast);

for (pos = forward; pos >= back; pos -= 1) {

left.write(pos);

right.write(pos);

delay(fast);

else if (pent > 450 && pent < 700) {

digitalWrite(blue, LOW);

digitalWrite(red, LOW);

digitalWrite(green, HIGH);

for (pos = back; pos <= forward; pos += 1) {

post = map(pos, 20, 160, 160, 20);

left.write(pos);
 right.write(post);

delay(slow);

for (pos = forward; pos >= back; pos -= 1) {

post = map(pos, 160, 20, 20, 160);

left.write(pos);

right.write(post);

delay(slow);

else if (pent > 700 && pent < 1023) {

digitalWrite(blue, LOW);

digitalWrite(red, HIGH);

digitalWrite(green, LOW);

for (pos = back; pos <= forward; pos += 1) {

post = map(pos, 20, 160, 160, 20);

left.write(pos);

right.write(post);

delay(fast);

for (pos = forward; pos >= back; pos -= 1) {

post = map(pos, 160, 20, 20, 160);

left.write(pos);

right.write(post);

delay(fast);