SimpleBot init

This commit is contained in:
mrbesen 2019-12-19 09:16:48 +01:00
parent 8d02b30818
commit f4f1b9c300
Signed by: MrBesen
GPG Key ID: 596B2350DCD67504
1 changed files with 54 additions and 0 deletions

54
SimpleBot/SimpleBot.ino Normal file
View File

@ -0,0 +1,54 @@
#define OVERTURN 200 //ms um wieviel überdreht wird
#define MOTORL 4 //motor pin links, on/off
#define MOTORLMODE 5 //motor pin links, mode
#define MOTORRMODE 6
#define MOTORR 7
#define SR analogRead(1) < 500 //Bedining, rechts - Schwarz
#define SL analogRead(2) < 500 //Bedining, links - Schwarz
void setup() {
pinMode(4, OUTPUT);
pinMode(5, OUTPUT);
pinMode(6, OUTPUT);
pinMode(7, OUTPUT);
stop();
}
void vor() {
}
void links() {
}
void rechts() {
}
void ruck() {
}
void stop() {
}
void loop() {
vor();
if(SR) {
rechts();
delay(OVERTURN);
}
if(SL) {
links();
delay(OVERTURN);
}
}