Maak je eerste Arduino-robot - De beste beginnersgids!

Code

• Bluetooth (gestuurde robot) schets
• Definitieve schets (eindcode)
• Schets van obstakelvermijder
• Schets van muurvolger

Bluetooth (gestuurde robot) schetsArduino

/*Auteur:Marcelo Moraes Dit project bevat code voor het publieke domein. De wijziging is toegestaan ​​zonder kennisgeving. *///Libraries#include //ObjectsAF_DCMotor motorRight(1, MOTOR12_64KHZ); // maak motor #1, 64KHz pwmAF_DCMotor motorLeft (3, MOTOR12_64KHZ); // maak motor #3, 64KHz pwm//Constanten en variabelechar dataIn ='S';char determinant;char det;int vel =0; // Bluetooth Stuffvoid setup () {Serial.begin (9600); // stel seriële bibliotheek in op 9600 bps // Initialisatieberichten Serial.println ("ArduinoBymyself - ROVERBot"); Serial.println ("AF-motortest!"); // zet motoren motorRight.setSpeed ​​(0) uit; motorLinks.setSpeed(0); motorRight.run(RELEASE); motorLeft.run(RELEASE); }void loop() { det =check(); //call check() subrotine om de seriële code te krijgen //serial code analysis switch (det){ case 'F':// F, move forward motorRight.setSpeed(vel); motorLinks.setSpeed(vel); motorRight.run(VOORUIT); motorLinks.lopen(VOORUIT); det =check(); pauze; case 'B':// B, ga terug motorRight.setSpeed(vel); motorLinks.setSpeed(vel); motorRight.run(ACHTERUIT); motorLinks.run(ACHTERUIT); det =check(); pauze; case 'L':// L, verplaats wielen naar links motorRight.setSpeed(vel); motorLinks.setSpeed(vel/4); motorRight.run(VOORUIT); motorLinks.lopen(VOORUIT); det =check(); pauze; case 'R':// R, verplaats wielen naar rechts motorRight.setSpeed(vel/4); motorLinks.setSpeed(vel); motorRight.run(VOORUIT); motorLinks.lopen(VOORUIT); det =check(); pauze; case 'I':// I, draai rechts vooruit motorRight.setSpeed(vel/2); motorLinks.setSpeed(vel); motorRight.run(VOORUIT); motorLinks.lopen(VOORUIT); det =check(); pauze; case 'J':// J, draai rechts terug motorRight.setSpeed(vel/2); motorLinks.setSpeed(vel); motorRight.run(ACHTERUIT); motorLinks.run(ACHTERUIT); det =check(); pauze; case 'G':// G, draai links vooruit motorRight.setSpeed(vel); motorLinks.setSpeed(vel/2); motorRight.run(VOORUIT); motorLinks.lopen(VOORUIT); det =check(); pauze; case 'H':// H, draai links terug motorRight.setSpeed(vel); motorLinks.setSpeed(vel/2); motorRight.run(ACHTERUIT); motorLinks.run(ACHTERUIT); det =check(); pauze; case 'S':// S, stop motorRight.setSpeed(vel); motorLinks.setSpeed(vel); motorRight.run(RELEASE); motorLeft.run(RELEASE); det =check(); pauze; }}// ontvang bluetooth-code ontvangen van seriële poort check(){ if (Serial.available()> 0){// if er zijn geldige gegevens in de seriële poort dataIn =Serial.read();// slaat gegevens op in een varialbe //check de code if (dataIn =='F'){//Forward determinant ='F'; } else if (dataIn =='B'){//Achterwaartse determinant ='B'; } else if (dataIn =='L'){//Links determinant ='L'; } else if (dataIn =='R'){//Right determinant ='R'; } else if (dataIn =='I'){//Froward Right determinant ='I'; } else if (dataIn =='J'){//Backward Right determinant ='J'; } else if (dataIn =='G'){//Forward Left determinant ='G'; } else if (dataIn =='H'){//Terug naar links determinant ='H'; } else if (dataIn =='S'){//Stop determinant ='S'; } else if (dataIn =='0'){//Snelheid 0 vel =0; } else if (dataIn =='1'){//Snelheid 25 vel =25; } else if (dataIn =='2'){//Snelheid 50 vel =50; } else if (dataIn =='3'){//Snelheid 75 vel =75; } else if (dataIn =='4'){//Snelheid 100 vel =100; } else if (dataIn =='5'){//Snelheid 125 vel =125; } else if (dataIn =='6'){//Snelheid 150 vel =150; } else if (dataIn =='7'){//Snelheid 175 vel =175; } else if (dataIn =='8'){//Snelheid 200 vel =200; } else if (dataIn =='9'){//Snelheid 225 vel =225; } else if (dataIn =='q'){//Snelheid 255 vel =255; } else if (dataIn =='U'){//Back Lights On determinant ='U'; } else if (dataIn =='u'){//Back Lights Off determinant ='u'; } else if (dataIn =='W'){//Front Lights On determinant ='W'; } else if (dataIn =='w'){//Front Lights Off determinant ='w'; } else if (dataIn =='V'){//Horn On determinant ='V'; } else if (dataIn =='v'){//Horn Off determinant ='v'; } else if (dataIn =='X'){//Extra On determinant ='X'; } else if (dataIn =='x'){//Extra Uit-determinant ='x'; } } determinant van het rendement;}

Definitieve schets (eindcode)Arduino

/*Auteur:Muhammed Azharvisit - robotechmaker.com*/#include #define trigPin 14 // definieer de pinnen van uw sensor#define echoPin 15 //ObjectsAF_DCMotor motorRight(1, MOTOR12_64KHZ); // maak motor #1, 64KHz pwmAF_DCMotor motorLeft (3, MOTOR12_64KHZ); // maak motor #3, 64KHz pwm//Constanten en variabelechar dataIn ='S';char determinant;char det;int vel =255; // Bluetooth Stuffvoid setup () {Serial.begin (9600); // stel seriële bibliotheek in op 9600 bps pinMode (trigPin, OUTPUT);// stel de trig-pin in op output (Send soundwaves) pinMode (echoPin, INPUT);// stel de echo-pin in op input (ontvang geluidsgolven) // /Initaliseringsberichten Serial.println ("Mr.robot"); Serial.println ("Reday om te werken!"); // zet motoren motorRight.setSpeed ​​(0) uit; motorLinks.setSpeed(0); motorRight.run(RELEASE); motorLeft.run(RELEASE);}void loop() { det =check(); //call check() subrotine om de seriële code te krijgen //serial code analysis switch (det){ case 'F':// F, move forward motorRight.setSpeed(vel); motorLinks.setSpeed(vel); motorRight.run(VOORUIT); motorLinks.lopen(VOORUIT); det =check(); pauze; case 'B':// B, ga terug motorRight.setSpeed(vel); motorLinks.setSpeed(vel); motorRight.run(ACHTERUIT); motorLinks.run(ACHTERUIT); det =check(); pauze; case 'L':// L, verplaats wielen naar links motorRight.setSpeed(vel); motorLinks.setSpeed(vel/4); motorRight.run(VOORUIT); motorLinks.lopen(VOORUIT); det =check(); pauze; case 'R':// R, verplaats wielen naar rechts motorRight.setSpeed(vel/4); motorLinks.setSpeed(vel); motorRight.run(VOORUIT); motorLinks.lopen(VOORUIT); det =check(); pauze; case 'I':// I, draai rechts vooruit motorRight.setSpeed(vel/2); motorLinks.setSpeed(vel); motorRight.run(VOORUIT); motorLinks.lopen(VOORUIT); det =check(); pauze; case 'J':// J, draai rechts terug motorRight.setSpeed(vel/2); motorLinks.setSpeed(vel); motorRight.run(ACHTERUIT); motorLinks.run(ACHTERUIT); det =check(); pauze; case 'G':// G, draai links vooruit motorRight.setSpeed(vel); motorLinks.setSpeed(vel/2); motorRight.run(VOORUIT); motorLinks.lopen(VOORUIT); det =check(); pauze; case 'H':// H, draai links terug motorRight.setSpeed(vel); motorLinks.setSpeed(vel/2); motorRight.run(ACHTERUIT); motorLinks.run(ACHTERUIT); det =check(); pauze; case 'S':// S, stop motorRight.setSpeed(vel); motorLinks.setSpeed(vel); motorRight.run(RELEASE); motorLeft.run(RELEASE); det =check(); pauze; case 'm'://voor muurvolgerrobot. motorRight.setSpeed(vel); // stel de snelheid van de motoren in, tussen 0-255 motorLeft.setSpeed ​​(vel); lange duur, afstand; // start de scan digitalWrite (trigPin, LOW); vertragingMicroseconden(2); // vertragingen zijn vereist voor een succesvolle sensorwerking. digitalWrite(trigPin, HOOG); vertraging Microseconden (10); // deze vertraging is ook vereist! digitalWrite(trigPin, LAAG); duur =pulseIn(echoPin, HOOG); afstand =(duur/2) / 29.1;// zet de afstand om in centimeters. if (afstand <30)/*De afstand die moet worden gehouden met de muur */ { Serial.println ("Muur is verwijderd!" );Serial.println (" Begonnen met het volgen van de muur ");Serial.println (" Draaien !"); motorRight.setSpeed(vel); motorLinks.setSpeed(0); motorRight.run(VOORUIT); motorLeft.run(RELEASE); vertraging (500); // wacht even} else { Serial.println ("Geen muur gedetecteerd. Draait om"); vertraging (15); motorRight.setSpeed(0); motorLinks.setSpeed(vel); motorRight.run(RELEASE); motorLinks draaien (VOORUIT); } pauze; geval 'b':// obstakelvermijder robot motorRight.setSpeed(vel); // stel de snelheid van de motoren in, tussen 0-255 motorLeft.setSpeed ​​(vel); lange bewondering, afstand; // start de scan digitalWrite (trigPin, LOW); vertragingMicroseconden(2); // vertragingen zijn vereist voor een succesvolle sensorwerking. digitalWrite(trigPin, HOOG); vertraging Microseconden (10); // deze vertraging is ook vereist! digitalWrite(trigPin, LAAG); Aduratie =pulseIn (echoPin, HOOG); Adistance =(Aduration/2) / 29.1;// zet de afstand om in centimeters. if (afstand <25)/*als er een obstakel is 25 centimeter, vooruit, doe het volgende:*/ { Serial.println ("Sluit obstakel gedetecteerd!" );Serial.println ("Obstacle Details:");Serial.print ("Distance From Robot is " );Serial.print ( Adistance);Serial.print (" CM!");// print de afstand in centimeters.Serial.println (" Het obstakel wordt als een bedreiging bestempeld vanwege de korte afstand . ");Serial.println (" Draaien !"); motorRight.setSpeed(vel); motorLinks.setSpeed(vel); motorLinks.run(ACHTERUIT); // Draai zolang er een obstakel voor je ligt. motorRight.run (FORWARD);} else { Serial.println ("Geen obstakel gedetecteerd. gaat vooruit"); vertraging (15); motorRight.setSpeed(vel); motorLinks.setSpeed(vel); motorRight.run(VOORUIT); //Als er geen obstakel voor de boeg is, ga dan vooruit! motorLinks.lopen(VOORUIT); } pauze; }}// ontvang bluetooth-code ontvangen van seriële poort check(){ if (Serial.available()> 0){// if er zijn geldige gegevens in de seriële poort dataIn =Serial.read();// slaat gegevens op in a varialbe//check de code if (dataIn =='F'){//Forward determinant ='F'; } else if (dataIn =='B'){//Achterwaartse determinant ='B'; } else if (dataIn =='L'){//Links determinant ='L'; } else if (dataIn =='R'){//Right determinant ='R'; } else if (dataIn =='I'){//Froward Right determinant ='I'; } else if (dataIn =='J'){//Backward Right determinant ='J'; } else if (dataIn =='G'){//Forward Left determinant ='G'; } else if (dataIn =='H'){//Terug naar links determinant ='H'; } else if (dataIn =='S'){//Stop determinant ='S'; } else if (dataIn =='0'){//Snelheid 0 vel =0; } else if (dataIn =='1'){//Snelheid 25 vel =25; } else if (dataIn =='2'){//Snelheid 50 vel =50; } else if (dataIn =='3'){//Snelheid 75 vel =75; } else if (dataIn =='4'){//Snelheid 100 vel =100; } else if (dataIn =='5'){//Snelheid 125 vel =125; } else if (dataIn =='6'){//Snelheid 150 vel =150; } else if (dataIn =='7'){//Snelheid 175 vel =175; } else if (dataIn =='8'){//Snelheid 200 vel =200; } else if (dataIn =='9'){//Snelheid 225 vel =225; } else if (dataIn =='b'){//Extra On determinant ='b'; } else if (dataIn =='m'){//Extra On determinant ='m'; } } determinant van het rendement;}

Obstacle Avoider SketchArduino

/*Auteur:Muhammed Azharvisit - robotechmaker.com*/#include #define trigPin 14 // definieer de pinnen van uw sensor#define echoPin 15 int vel =255; // Snelheid van de robot//ObjectsAF_DCMotor motorRight (1, MOTOR12_64KHZ); // maak motor #1, 64KHz pwmAF_DCMotor motorLeft (3, MOTOR12_64KHZ); // maak motor #3, 64KHz pwmvoid setup() {Serial.begin (9600); // stel seriële bibliotheek in op 9600 bps pinMode (trigPin, OUTPUT);// stel de trig-pin in op output (Send soundwaves) pinMode (echoPin, INPUT);// stel de echo-pin in op input (ontvang geluidsgolven) // /Initaliseringsberichten Serial.println ("Mr.robot"); Serial.println ("Reday om te werken!"); // zet motoren motorRight.setSpeed ​​(0) uit; motorLinks.setSpeed(0); motorRight.run(RELEASE); motorLeft.run(RELEASE);}void loop() {//obstakelvermijder robot motorRight.setSpeed(vel); // stel de snelheid van de motoren in, tussen 0-255 motorLeft.setSpeed ​​(vel); lange duur, afstand; // start de scan digitalWrite (trigPin, LOW); vertragingMicroseconden(2); // vertragingen zijn vereist voor een succesvolle sensorwerking. digitalWrite(trigPin, HOOG); vertraging Microseconden (10); // deze vertraging is ook vereist! digitalWrite(trigPin, LAAG); duur =pulseIn(echoPin, HOOG); afstand =(duur/2) / 29.1;// zet de afstand om in centimeters. if (afstand <25)/*als er een obstakel is 25 centimeter, vooruit, doe het volgende:*/ { Serial.println ("Sluit obstakel gedetecteerd!" );Serial.println ("Obstacle Details:");Serial.print ("Distance From Robot is " );Serial.print ( distance);Serial.print (" CM!");// print de afstand in centimeters.Serial.println (" Het obstakel wordt als een bedreiging bestempeld vanwege de korte afstand . ");Serial.println (" Draaien !"); motorRight.setSpeed(vel); motorLinks.setSpeed(vel); motorLinks.run(ACHTERUIT); // Draai zolang er een obstakel voor je ligt. motorRight.run (FORWARD);} else { Serial.println ("Geen obstakel gedetecteerd. gaat vooruit"); vertraging (15); motorRight.setSpeed(vel); motorLinks.setSpeed(vel); motorRight.run(VOORUIT); // als er geen obstakel voor de boeg is, ga dan vooruit! motorLinks.lopen(VOORUIT); } } 

Muurvolger SchetsArduino

/*Auteur:Muhammed Azharvisit - robotechmaker.com*/#include #define trigPin 14 // definieer de pinnen van uw sensor#define echoPin 15 int vel =255; // Snelheid van de robot // ObjectsAF_DCMotor motorRight (1, MOTOR12_64KHZ); // maak motor #1, 64KHz pwmAF_DCMotor motorLeft (3, MOTOR12_64KHZ); // maak motor #3, 64KHz pwmvoid setup(){Serial.begin(9600); // stel seriële bibliotheek in op 9600 bps pinMode (trigPin, OUTPUT);// stel de trig-pin in op output (Send soundwaves) pinMode (echoPin, INPUT);// stel de echo-pin in op input (ontvang geluidsgolven) // /Initaliseringsberichten Serial.println ("Mr.robot"); Serial.println ("Reday om te werken!"); // zet motoren motorRight.setSpeed ​​(0) uit; motorLinks.setSpeed(0); motorRight.run(RELEASE); motorLeft.run(RELEASE);}void loop(){ // for wall follower robot. motorRight.setSpeed(vel); // stel de snelheid van de motoren in, tussen 0-255 motorLeft.setSpeed ​​(vel); lange duur, afstand; // start de scan digitalWrite (trigPin, LOW); vertragingMicroseconden(2); // vertragingen zijn vereist voor een succesvolle sensorwerking. digitalWrite(trigPin, HOOG); vertraging Microseconden (10); // deze vertraging is ook vereist! digitalWrite(trigPin, LAAG); duur =pulseIn(echoPin, HOOG); afstand =(duur / 2) / 29,1;// zet de afstand om in centimeters. if (afstand <30)/*De afstand die moet worden gehouden met de muur */ { Serial.println("Muur is verwijderd!"); Serial.println(" Begonnen met het volgen van de muur "); Serial.println(" Draait !"); motorRight.setSpeed(vel); motorLinks.setSpeed(0); motorRight.run(VOORUIT); motorLinks.run(RELEASE); vertraging (500); // wacht even } else { Serial.println ("Geen muur gedetecteerd. Draait om"); vertraging (15); motorRight.setSpeed(0); motorLinks.setSpeed(vel); motorRight.run(RELEASE); motorLinks.lopen(VOORUIT); }}

Schema's