Download - Source Code
SOURCECODE
#include
Servovert;
Servo des;
int motora1 = 5;
intmotora2 = 6;
intmotorb1 = 9;
int motorb2 = 10;
intbyt;
intvpos = 0;
intval=0;
intflag = 0;
voidsetup() {
// put your setup code here, to run once:
Serial.begin(9600);
vert.attach(11);
des.attach(3);
vert.write(20);
des.write(90);
pinMode(motora1,OUTPUT);
pinMode(motora2,OUTPUT);
pinMode(motorb1,OUTPUT);
pinMode(motorb2,OUTPUT);
}
voidfw ()
{
digitalWrite(motora1,HIGH);
digitalWrite(motora2,LOW);
digitalWrite(motorb1,HIGH);
digitalWrite(motorb2,LOW);
}
voidrv ()
{
digitalWrite(motora1,LOW);
digitalWrite(motora2,HIGH);
digitalWrite(motorb1,LOW);
digitalWrite(motorb2,HIGH);
}
void lf ()
{
digitalWrite(motora1,HIGH);
digitalWrite(motora2,LOW);
digitalWrite(motorb1,LOW);
digitalWrite(motorb2,HIGH);
}
voidrt ()
{
digitalWrite(motora1,LOW);
digitalWrite(motora2,HIGH);
digitalWrite(motorb1,HIGH);
digitalWrite(motorb2,LOW);
}
voidst ()
{
digitalWrite(motora1,LOW);
digitalWrite(motora2,LOW);
digitalWrite(motorb1,LOW);
digitalWrite(motorb2,LOW);
}
voidloop () {
if(Serial.available() > 0){
byt=Serial.read();
flag=1;
if((byt == 205) && (flag == 1)){
fw();
flag=0;
}
if((byt == 208) && (flag== 1)){
rv();
flag=0;
}
if ((byt == 207) && (flag == 1)){
rt();
flag=0;
}
if((byt == 206) && (flag == 1)){
lf();
flag=0;
}
if((byt == 210) && (flag == 1)){
st();
flag=0;
}
if((byt>=0) && (byt
