int leftForward = 5; int leftBackward = 6; int rightForward = 9; int rightBackward = 10; int go = 255; // Motortoerental (0-255) int state = 'W'; // Start void setup() { Serial.begin(9600); // Bluetooth verbinding pinMode(rightForward, OUTPUT); pinMode(rightBackward, OUTPUT); pinMode(leftForward, OUTPUT); pinMode(leftBackward, OUTPUT); } void loop() { if(Serial.available()>0){ // Leest de bluetooth en geeft door in welke staat hij zit state = Serial.read(); } if(state=='F'){ // Forward Serial.println(state); analogWrite(rightBackward, 0); analogWrite(leftBackward, 0); analogWrite(rightForward, go); analogWrite(leftForward, go); } if(state=='R'){ // Right Serial.println(state); analogWrite(rightBackward, go); analogWrite(leftBackward, 0); analogWrite(rightForward, 0); analogWrite(leftForward, go); } if(state=='S'){ // Stop Serial.println(state); analogWrite(rightBackward, 0); analogWrite(leftBackward, 0); analogWrite(rightForward, 0); analogWrite(leftForward, 0); } if(state=='L'){ // Left Serial.println(state); analogWrite(rightBackward, 0); analogWrite(leftBackward, go); analogWrite(rightForward, 0); analogWrite(leftForward, go); } if(state=='B'){ // Reverse Serial.println(state); analogWrite(rightBackward, go); analogWrite(leftBackward, go); analogWrite(rightForward, 0); analogWrite(leftForward, 0); } if (state =='U'){ // Aan knop, verplaatst de detectieafstand } if (state=='W'){ // Uit knop, doet niks meer. } }