Code:
#include "qfixBobbyBoard.h"
#include "qfixLCD.h"
BobbyBoard bobby;
LCD lcd;
bool lastDirRight;
int main()
{
lcd.lightOn();
lcd.clear();
lcd.print(1,7,"Soccer");
int ballsensor = bobby.analog(1);
bobby.motor(0,-255);
bobby.motor(1,255);
sleep(3);
bobby.motor(0,-0);
bobby.motor(0,0);
while (1)
{
if ((bobby.analog(1)<bobby.analog(2)) && (bobby.analog(1)>ballsensor)) {
bobby.motor(0,0);
bobby.motor(1,-255);
lastDirRight=true;
bobby.ledOff(0);
bobby.ledOff(1);
bobby.ledOff(2);
bobby.ledOff(3);
lcd.clear();
lcd.print(0,2,"suchen des Balls");
lcd.print(3,0,"###");
lcd.print(3,17,"###");
}
else if ((bobby.analog(2)<bobby.analog(1)) && (bobby.analog(2)>ballsensor)) {
bobby.motor(0,255);
bobby.motor(1,0);
lastDirRight=false;
bobby.ledOff(0);
bobby.ledOff(1);
bobby.ledOff(2);
bobby.ledOff(3);
lcd.clear();
lcd.print(0,2,"suchen des Balls");
lcd.print(3,0,"###");
lcd.print(3,17,"###");
}
else if ((bobby.analog(1)>ballsensor) && (bobby.analog(2)>ballsensor)) {
bobby.motor(0,255);
bobby.motor(1,-255);
bobby.ledOff(0);
bobby.ledOff(1);
bobby.ledOff(2);
bobby.ledOff(3);
lcd.clear();
lcd.print(0,2,"suchen des Balls");
lcd.print(3,0,"###");
lcd.print(3,17,"###");
}
else {
if (lastDirRight) {
bobby.motor(0,-255);
bobby.motor(1,-255);
bobby.ledOff(0);
bobby.ledOff(1);
bobby.ledOn(2);
bobby.ledOn(3);
cd.clear();
lcd.print(0,2,"suchen des Balls");
cd.print(2,6,"Teil eins");
}
else {
bobby.motor(0,255);
bobby.motor(1,255);
bobby.ledOn(0);
bobby.ledOn(1);
bobby.ledOff(2);
bobby.ledOff(3);
lcd.clear();
lcd.print(0,2,"suchen des Balls");
lcd.print(2,6,"Teil eins");
}
}
}
}
Ich habe das Programm für ein Referat an meiner Schule geschrieben und deswegen hat es auch so einen Kram mit dem LCD und LEDs.
Lesezeichen