Stap 4: De code:-
Je Arduino verbinden met uw aangewezen apparaat en uploaden van de code.pls de code volgens uw gemak en uw onderdelen aanpassen want je zal niet de exacte onderdelen vinden.
Code:-
#include
AF_DCMotor motor1(1);
AF_DCMotor motor2(2);
AF_DCMotor motor3(3);
AF_DCMotor motor4(4);
char opdracht;
VOID Setup
{
Serial.begin(9600); Stel de baud-rate op uw Bluetooth-module
}
void loop {}
if(Serial.available(), > 0) {}
Command=Serial.Read();
Stop(); initialiseren met motoren gestopt
Pens-modus alleen wijzigen als nieuwe opdracht anders dan de vorige is.
Serial.printIn(command);
switch(Command) {}
Case "F":
vooruit();
breken;
Case "B":
Back();
breken;
geval 'L':
datumwaarde;
breken;
Case 'R':
rechts();
breken;
Case 'G':
forwardleft();
breken;
Case 'ik':
voorwaartse rechts();
breken;
Case "H":
: backleft();
breken;
Case "J":
: backright();
breken;
}
}
}
VOID vooruit()
{
motor1.setSpeed(255);
motor1.run(forward);
Motor2.setSpeed(255);
Motor2.run(forward);
motor3.setSpeed(255);
motor3.run(forward);
motor4.setSpeed(255);
motor4.run(forward);
}
VOID back()
{
motor1.setSpeed(255);
motor1.run(BACKWARD);
Motor2.setSpeed(255);
Motor2.run(BACKWARD);
motor3.setSpeed(255);
motor3.run(BACKWARD);
motor4.setSpeed(255);
motor4.run(BACKWARD);
}
VOID datumwaarde
{
motor1.setSpeed(0);
motor1.run(release);
Motor2.setSpeed(0);
Motor2.run(release);
motor3.setSpeed(255);
motor3.run(forward);
motor4.setSpeed(255);
motor4.run(forward);
}
VOID rechts()
{
motor1.setSpeed(255);
motor1.run(forward);
Motor2.setSpeed(255);
Motor2.run(forward);
motor3.setSpeed(0);
motor3.run(release);
motor4.setSpeed(0);
motor4.run(release);
}
VOID forwardleft()
{
motor1.setSpeed(240);
motor1.run(forward);
Motor2.setSpeed(240);
Motor2.run(forward);
motor3.setSpeed(255);
motor3.run(forward);
motor4.setSpeed(255);
motor4.run(forward);
}
VOID forwardright()
{
motor1.setSpeed(255);
motor1.run(forward);
Motor2.setSpeed(255);
Motor2.run(forward);
motor3.setSpeed(240);
motor3.run(forward);
motor4.setSpeed(240);
motor4.run(forward);
}
VOID backleft()
{
motor1.setSpeed(240);
motor1.run(BACKWARD);
Motor2.setSpeed(240);
Motor2.run(BACKWARD);
motor3.setSpeed(255);
motor3.run(BACKWARD);
motor4.setSpeed(255);
motor4.run(BACKWARD);
}
VOID backright()
{
motor1.setSpeed(255);
motor1.run(BACKWARD);
Motor2.setSpeed(255);
Motor2.run(BACKWARD);
motor3.setSpeed(240);
motor3.run(BACKWARD);
motor4.setSpeed(240);
motor4.run(BACKWARD);
}
VOID Stop()
{
motor1.setSpeed(0);
motor1.run(release);
Motor2.setSpeed(0);
Motor2.run(release);
motor3.setSpeed(0);
motor3.run(release);
motor4.setSpeed(0);
motor4.run(release);
}
pls wijzigen de motor waarden volgens uw gemak en motoren