55 lines
650 B
C++
55 lines
650 B
C++
#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);
|
|
}
|
|
}
|
|
|