String voice;
int M1 = 7;
int M2 = 6;
int M3 = 5;
int M4 = 4;
void backward() {
digitalWrite (M1, HIGH);
digitalWrite (M2, LOW);
digitalWrite (M3, HIGH);
digitalWrite (M4, LOW);
}
void forward() {
digitalWrite (M1, LOW);
digitalWrite (M2, HIGH);
digitalWrite (M3, LOW);
digitalWrite (M4, HIGH);
}
void right() {
digitalWrite (M4, LOW);
digitalWrite (M2, HIGH);
digitalWrite (M3, LOW);
digitalWrite (M1, LOW);
delay (400);
digitalWrite(M4, HIGH);
digitalWrite (M2, HIGH);
digitalWrite(M3,LOW);
digitalWrite(M1,LOW);
delay(100);
void left() {
digitalWrite (M4, HIGH);
digitalWrite (M2, LOW);
digitalWrite (M3, LOW);
digitalWrite (M1, LOW);
delay (400);
digitalWrite(M4, HIGH);
digitalWrite (M2, HIGH);
digitalWrite(M3,LOW);
digitalWrite(M1,LOW);
delay(100);
void stop() {
digitalWrite (M1, LOW);
digitalWrite (M2, LOW);
digitalWrite (M3, LOW);
digitalWrite (M4, LOW);
}
void circle(){
digitalWrite (M4, HIGH);
digitalWrite (M2, LOW);
digitalWrite (M3, LOW);
digitalWrite (M1, HIGH);
delay (100);
void dance(){
digitalWrite (M4, LOW);
digitalWrite (M2, HIGH);
digitalWrite (M3, LOW);
digitalWrite (M1, LOW);
delay (400);
digitalWrite(M4, HIGH);
digitalWrite (M2, HIGH);
digitalWrite(M3,LOW);
digitalWrite(M1,LOW);
delay(600);
digitalWrite (M4, LOW);
digitalWrite (M2, HIGH);
digitalWrite (M3, HIGH);
digitalWrite (M1, LOW);
delay (500);
digitalWrite (M4, HIGH);
digitalWrite (M2, LOW);
digitalWrite (M3, LOW);
digitalWrite (M1, HIGH);
delay (500);
digitalWrite (M4, LOW);
digitalWrite (M2, HIGH);
digitalWrite (M3, LOW);
digitalWrite (M1, LOW);
delay (400);
digitalWrite(M4, HIGH);
digitalWrite (M2, HIGH);
digitalWrite(M3,LOW);
digitalWrite(M1,LOW);
delay(600);
digitalWrite (M4, LOW);
digitalWrite (M2, HIGH);
digitalWrite (M3, HIGH);
digitalWrite (M1, LOW);
delay (500);
digitalWrite (M4, HIGH);
digitalWrite (M2, LOW);
digitalWrite (M3, LOW);
digitalWrite (M1, HIGH);
delay (500);
digitalWrite (M4, LOW);
digitalWrite (M2, HIGH);
digitalWrite (M3, LOW);
digitalWrite (M1, LOW);
delay (400);
digitalWrite(M4, HIGH);
digitalWrite (M2, HIGH);
digitalWrite(M3,LOW);
digitalWrite(M1,LOW);
delay(600);
digitalWrite (M4, LOW);
digitalWrite (M2, HIGH);
digitalWrite (M3, HIGH);
digitalWrite (M1, LOW);
delay (500);
digitalWrite (M4, HIGH);
digitalWrite (M2, LOW);
digitalWrite (M3, LOW);
digitalWrite (M1, HIGH);
delay (500);
digitalWrite (M4, LOW);
digitalWrite (M2, HIGH);
digitalWrite (M3, LOW);
digitalWrite (M1, LOW);
delay (400);
digitalWrite(M4,HIGH);
digitalWrite(M2,HIGH);
digitalWrite(M3,LOW);
digitalWrite(M1,LOW);
delay(600);
digitalWrite (M4, LOW);
digitalWrite (M2, HIGH);
digitalWrite (M3, HIGH);
digitalWrite (M1, LOW);
delay (500);
digitalWrite (M4, HIGH);
digitalWrite (M2, LOW);
digitalWrite (M3, LOW);
digitalWrite (M1, HIGH);
delay (500);
digitalWrite (M4, LOW);
digitalWrite (M2, HIGH);
digitalWrite (M3, LOW);
digitalWrite (M1, LOW);
delay (400);
digitalWrite(M4, HIGH);
digitalWrite (M2, HIGH);
digitalWrite(M3,LOW);
digitalWrite(M1,LOW);
delay(600);
digitalWrite (M4, LOW);
digitalWrite (M2, HIGH);
digitalWrite (M3, HIGH);
digitalWrite (M1, LOW);
delay (500);
digitalWrite (M4, HIGH);
digitalWrite (M2, LOW);
digitalWrite (M3, LOW);
digitalWrite (M1, HIGH);
delay (500);
digitalWrite (M4, LOW);
digitalWrite (M2, HIGH);
digitalWrite (M3, LOW);
digitalWrite (M1, LOW);
delay (400);
digitalWrite(M4, HIGH);
digitalWrite (M2, HIGH);
digitalWrite(M3,LOW);
digitalWrite(M1,LOW);
delay(600);
digitalWrite (M4, LOW);
digitalWrite (M2, HIGH);
digitalWrite (M3, HIGH);
digitalWrite (M1, LOW);
delay (500);
digitalWrite (M4, HIGH);
digitalWrite (M2, LOW);
digitalWrite (M3, LOW);
digitalWrite (M1, HIGH);
delay (500);
digitalWrite (M4, LOW);
digitalWrite (M2, HIGH);
digitalWrite (M3, LOW);
digitalWrite (M1, LOW);
delay (400);
digitalWrite(M4, HIGH);
digitalWrite (M2, HIGH);
digitalWrite(M3,LOW);
digitalWrite(M1,LOW);
delay(600);
digitalWrite (M4, LOW);
digitalWrite (M2, HIGH);
digitalWrite (M3, HIGH);
digitalWrite (M1, LOW);
delay (500);
digitalWrite (M4, HIGH);
digitalWrite (M2, LOW);
digitalWrite (M3, LOW);
digitalWrite (M1, HIGH);
delay (500);
digitalWrite (M4, LOW);
digitalWrite (M2, HIGH);
digitalWrite (M3, LOW);
digitalWrite (M1, LOW);
delay (400);
digitalWrite(M4, HIGH);
digitalWrite (M2, HIGH);
digitalWrite(M3,LOW);
digitalWrite(M1,LOW);
delay(600);
digitalWrite (M4, LOW);
digitalWrite (M2, HIGH);
digitalWrite (M3, HIGH);
digitalWrite (M1, LOW);
delay (500);
digitalWrite (M4, HIGH);
digitalWrite (M2, LOW);
digitalWrite (M3, LOW);
digitalWrite (M1, HIGH);
delay (500);
}
void setup() {
Serial.begin(9600);
pinMode(M1, OUTPUT);
pinMode(M2, OUTPUT);
pinMode(M3, OUTPUT);
pinMode(M4, OUTPUT);
}
void loop() {
while(Serial.available()) {
delay(10);
char c=Serial.read();
if(c=='#')
{break; }
voice += c;
}
if (voice.length() > 0) {
Serial.println(voice);
if (voice == "*forward")
{forward() ; }
else if (voice == "*backward")
{backward() ; }
else if (voice == "*left")
{left() ; }
else if (voice == "*right")
{right() ; }
else if (voice == "*stop")
{stop() ; }
else if (voice == "*dance")
{dance() ; }
else if (voice == "*circle")
{circle() ; }
voice="";
}
}