Stap 4: Ardunio Code
Voor foutopsporing moet u de seriële Monitor van Arduino om te zien de Serial.println("") berichten van de ardunio terwijl deze is aangesloten op de computer via USB.
#include SoftwareSerial
mySerial (10, 11); RX, TX
int geleid = 13;
char myChar = "a";
Tekenreeks met;
char LorR;
int enA = 3;
int in1 = 4;
int in2 = 5;
int enB = 6;
int 3 = 7;
int in4 = 8;
VOID Setup
{
Seriële communicatie te openen en te wachten voor de poort te openen:
Serial.begin(57600);
pinMode led (, uitvoer);
Serial.println ("Goodnight moon!");
Stel de gegevenssnelheid voor de SoftwareSerial-poort
mySerial.begin(9600);
mySerial.println ("Hello, world?");
pinMode (enA, OUTPUT);
pinMode (in1, OUTPUT);
pinMode (in2, OUTPUT);
pinMode (enB, OUTPUT);
pinMode (3, OUTPUT);
pinMode (in4, OUTPUT);
}
void loop / / run over en voorbij
{
tekenreeks = "";
Voeg toe aan de tekenreeks
while (true) {}
myChar=mySerial.read();
Als (32 < = myChar & & myChar < = 127) {}
tekenreeks += myChar;
}
Als (myChar ==' :'){
breken;
}
delay(10);
} / / Terwijl einde
Analyseren van tekenreeks
Als (tekenreeks! = "uit:" & & tekenreeks! = "op :"){
Als (tekenreeks! = "L0:" & & tekenreeks! = "R0:") {}
code voor het instellen van motor links of rechts
Als (string[0]=='L') {}
LorR = 'L';
} else {}
LorR = 'R';
}
string.Remove (0, 1);
code voor het aanbrengen van het in omgekeerde
Als (string[0]=='-') {}
string.Remove (0, 1);
string.Remove((string.length()-1), 1);
Serial.println(String);
Als (LorR == 'L') {}
digitalWrite (in1, hoge);
digitalWrite (in2, laag);
analogWrite (enA, string.toInt());
} else {}
digitalWrite (3, laag);
digitalWrite (in4, hoge);
analogWrite (enB, string.toInt());
}
} else {}
string.Remove((string.length()-1), 1);
Serial.println(String);
Als (LorR == 'L') {}
digitalWrite (in1, laag);
digitalWrite (in2, hoge);
analogWrite (enA, string.toInt());
} else {}
digitalWrite (3, hoge);
digitalWrite (in4, laag);
analogWrite (enB, string.toInt());
}
}
} else {}
digitalWrite (in1, laag);
digitalWrite (in2, laag);
digitalWrite (3, laag);
digitalWrite (in4, laag);
}
} //End lange als verklaring
Als (tekenreeks == "op :"){
digitalWrite (led, hoog);
}
Als (tekenreeks == "off :"){
digitalWrite (led, laag);
}
} //Loop einde