hi
ich habe mal zum test ein programm geschrieben. Dabei soll der Roboter auf händeklatschen reagieren. beim ersten klatschen sollen zwei LEDs blinken und beim 2ten mal klatschen soll der bot sich hin und her drehen. damit er beim ausführen der aktionen auch weiterhin seinen MIC eingang beobachtet habe ich hierzu Multithreading angewendet.
nun habe ich aber ein problem, da wenn ich 2 mal in die hände geklatscht habe dann bewegt sich der bot kaum von der stelle. und beim nächsten mal klatschen bewegt er sich wieder ein stück obwohl er dann komplett ewieder in ruhestellung fahren sollte. ich habe das gefühl das durch die akustische signalisierung der trtead erst wieder angestoßen wird... aber deim thread Licht klappt alle wunderbar.... könnt ihr mir helfen?
im anhang habe ich den Quelltext....
danke im vorraus..
Code://************************************************************** // // Wackeln // Erstes Programm 30.12.2010 // Probot lauscht: // beim ersten klatschen -> Blinken // zweitem klatschen -> Tanzen // dritten klatschen -> Ruhe // //************************************************************** #define LLF 16 #define RLF 17 #define LLB 18 #define RLB 19 #define MIC 43 word x; // globale variablen erstellt int count; void main(void) { DRIVE_INIT(); // Drive initalisieren siehe PRO-BOT128_Lib count=0; // setzte den KLatschzähler auf 0 Port_DataDirBit(LLF,1); Port_DataDirBit(RLF,1); // initaliesiere die LEDs Port_DataDirBit(LLB,1); Port_DataDirBit(RLB,1); Thread_Delay(100); //Konfiguriere die ports als ausgänge und warte ne sekund Port_WriteBit(LLF,0); Port_WriteBit(RLF,0); Port_WriteBit(LLB,0); Port_WriteBit(RLB,0); Thread_Delay(50); Port_WriteBit(LLF,1); //LEDs aufblinken lassen zum signalisieren das es jetzt los gehen kann Port_WriteBit(RLF,1); Port_WriteBit(LLB,1); Port_WriteBit(RLB,1); while(1==1) //endlosschleife { x=GetADC(3); //schreibe den Wert vom MIC in x if (x>600) //wenn x größer 600... { count++; //...zähle hoch Thread_Delay(10); } switch(count) { case 0: break; //counter = 0 nix case 1: Thread_Start(1,Light);count++;break; //counter = 1mal geklatscht -> Thread Light starten. counter eins hoch zählen damit der thread nicht immer gestartet wird. case 2: break; case 3: Thread_Start(2,Fahr)/*Fahr()*/;count++;break; //counter =3 -> 2mal geklatscht. Thread Fahr case 4: break; default: count=0; Thread_Kill(1); Thread_Kill(2); //wenn counter größer als 4 oder undefiniert dann schliße Port_WriteBit(15,0); // beide threads und schalte alle LEDs aus Port_WriteBit(LLF,1); //EN ausgang für motoren wird abgeschaltet Port_WriteBit(RLF,1); Port_WriteBit(LLB,1); Port_WriteBit(RLB,1); } } } word GetADC(int adr) //ließt wert aus ADC eingang aus { ADC_Set(ADC_VREF_BG,adr); return ADC_Read(); } void Light(void) //Light funzt... aber LEDs sind vertauscht.... ?! { while(1) { // Port_WriteBit(LLF,1); // Port_WriteBit(RLF,1); Port_WriteBit(LLB,1); Port_WriteBit(RLB,1); Thread_Delay(250); // Port_WriteBit(LLF,1); // Port_WriteBit(RLF,1); Port_WriteBit(LLB,0); Port_WriteBit(RLB,0); Thread_Delay(250); } } void Fahr(void) //funktioniert nicht.... :( { Port_WriteBit(15,1); //setzte EN eingang der Motoren while(1) //endlosschleife { DRIVE(1,255); //dreh dich 2,5s in eine richtung Thread_Delay(250); DRIVE(128,128); //bleib stehen Thread_Delay(250); DRIVE(255,1); //fahr in die andere richtung Thread_Delay(250); DRIVE(128,128); //bleib stehen Thread_Delay(250); } }
Zitieren
Lesezeichen