#include <LiquidCrystal.
h>
#include <Servo.h>
void UpDown();
void LeftRight();
Servo servo1;
Servo servo2;
LiquidCrystal lcd(12, 11, 5, 4, 3, 2);
void setup() {
[Link](16,2);
[Link]("servo1 ");
[Link](0,1);
[Link]("servo2 ");
[Link](9);
[Link](10);
[Link](90);
[Link](90);
}
void loop(){
int sensorTop = analogRead(A0);
int sensorBottom = analogRead(A1);
int sensorLeft = analogRead(A3);
int sensorRight = analogRead(A4);
int avgT=(sensorTop+sensorBottom)/2;
int avgB=(sensorLeft+sensorRight)/2;
int avgL=(sensorTop+sensorLeft)/2;
int avgR=(sensorBottom+sensorRight)/2;
if (avgT > avgB)
{
UpDown(sensorTop, sensorBottom);
}
if(avgT < avgB)
{
UpDown(sensorTop, sensorBottom);
}
if(avgL > avgR)
{
LeftRight(sensorLeft, sensorRight);
}
if(avgL < avgR)
{
LeftRight(sensorLeft, sensorRight);
}
delay(10);
}
void UpDown(int avgT, int avgB){
int pos1= [Link]();
if(avgT < avgB){
pos1 = --pos1;
}
else
{
pos1 = ++pos1;
}
[Link](pos1);
[Link](12,0);
[Link](pos1);
}
void LeftRight(int avgL, int avgR){
int pos2= [Link]();
if(avgL < avgR)
{
pos2 = --pos2;
}
else
{
pos2 = pos2 + 1;
}
[Link](pos2);
[Link](12,1);
[Link](pos2);
}