Stap 4: Upload schets voor Bluetooth
Onderstaande code uploaden.
*/
#include < AFMotor.h >
char val; Variabele gegevens kunnen ontvangen van de seriële poort
DC-motor op de M1
AF_DCMotor motor(1);
DC-motor op de M2
AF_DCMotor motor2(2);
int i;
VOID Setup {}
Serial.begin(115200);
inschakelen motor #1
motor.setSpeed(200);
motor.run(release);
inschakelen motor #2
Motor2.setSpeed(200);
Motor2.run(release);
}
Vooruit
ongeldig go_forward() {}
motor.run(forward);
Motor2.run(forward);
voor (ik = 0; ik < 255; i ++) {}
motor.setSpeed(i);
Motor2.setSpeed(i);
}
}
OMGEKEERDE verplaatsen
ongeldig go_reverse() {}
motor.run(BACKWARD);
Motor2.run(BACKWARD);
voor (ik = 0; ik < 255; i ++) {}
motor.setSpeed(i);
Motor2.setSpeed(i);
}
}
LINKS verplaatsen
ongeldig go_left() {}
motor.run(forward);
voor (ik = 0; ik < 255; i ++) {}
motor.setSpeed(i);
}
}
Naar rechts verplaatsen
ongeldig go_right() {}
Motor2.run(forward);
voor (ik = 0; ik < 255; i ++) {}
Motor2.setSpeed(i);
}
}
Lezen van de seriële poort en de opdracht uitvoeren
ongeldig performCommand() {}
Als (Serial.available()) {}
Val = Serial.read();
}
Als (val == 'f') {/ / vooruit
go_forward();
} else if (val == 'z') {/ / Stop vooruit
stop_go_forward();
} else if (val == 'b') {/ / Reverse
go_reverse();
} else if (val == 'y') {/ / stoppen Reverse
stop_go_reverse();
} else if (val == 'l') {/ / rechts
go_right();
} else if (val == 'r') {/ / links
go_left();
} else if (val == 't') {/ / Stop auto met behulp van turbofunctie
stop_car();
}
}
void loop {}
performCommand();
}
code eindigt hier