SimpleBot init
This commit is contained in:
parent
8d02b30818
commit
f4f1b9c300
|
@ -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);
|
||||
}
|
||||
}
|
||||
|
Loading…
Reference in New Issue