Fertiges Labyrinthprogramm!!!!
Hi@all,
ich habe zufällig im Forum dieses Programm gefunden, um meinen Asuro durch ein Rechtwinkliges Labyrinth fahren zu lassen.
Code:
#include "asuro.h"
#define FULL_L 200
#define FULL_R 205
volatile unsigned int i;
void Fahren(void) /* Vorwärts fahren */
{
StatusLED(GREEN);
BackLED(OFF,OFF);
MotorDir(FWD,FWD);
MotorSpeed(FULL_L,FULL_R);
}
void Anhalten(void) /* Anhalten */
{
StatusLED(RED);
BackLED(OFF,OFF);
MotorDir(BREAK,BREAK);
}
void Zurueck(void) /* Zurück fahren */
{
StatusLED(YELLOW);
BackLED(ON,ON);
MotorDir(RWD,RWD);
MotorSpeed(FULL_L,FULL_R);
}
void KurveLR(void) /* Kurve rückwärts Links */
{
StatusLED(YELLOW);
BackLED(ON,OFF);
MotorDir(RWD,RWD);
MotorSpeed(FULL_L,0);
}
void KurveRR(void) /* Kurve rückwärts Rechts */
{
StatusLED(YELLOW);
BackLED(OFF,ON);
MotorDir(RWD,RWD);
MotorSpeed(0, FULL_R);
}
void KurveRF(void) /* Kurve vorwärts Rechts */
{
StatusLED(YELLOW);
BackLED(OFF,OFF);
MotorDir(BREAK,FWD);
MotorSpeed(0,FULL_R);
}
void Firstcol(void) /* Programm Rechtskurve im Parcour 1. Kollision */
{
Anhalten();
Msleep(250);
Zurueck();
Msleep(15);
Anhalten();
Msleep(10);
KurveRR();
Msleep(400);
Anhalten();
Msleep(250);
switched = 0;
StartSwitch ();
}
void Secondcol(void) /* Programm Linkskurve im Parcour, 2. Kollision */
{
Anhalten();
Msleep(250);
Zurueck();
Msleep(10);
Anhalten();
Msleep(250);
KurveLR();
Msleep(355);
Anhalten();
Msleep(250);
KurveRF();
Msleep(355);
Anhalten();
Msleep(250);
switched = 0;
StartSwitch();
}
void Thirdcol(void) /* Programm Sackgasse im Parcour, 3. Kollision */
{
Anhalten();
Msleep(250);
Zurueck();
Msleep(10);
KurveLR();
Msleep(310);
Anhalten();
Msleep(250);
switched = 0;
StartSwitch();
}
void Disco(void) /* PARTYTIME! -15mal blinken/piepsen-*/
{
for(i = 0; i < 16; i++)
{
MotorDir(FWD,FWD);
MotorSpeed(50,50);
BackLED(OFF,OFF);
StatusLED(OFF);
FrontLED(OFF);
Msleep(200);
MotorDir(BREAK,BREAK);
BackLED(ON,ON);
StatusLED(RED);
FrontLED(ON);
Msleep(200);
}
}
int main (void) /* Hauptprogrammbeginn */
{
unsigned int data[2]; /* Speicherplpatz für Helligkeitswert */
unsigned int Summe;
Init ();
switched = 0; /* Kollisionserkennung auf 0 setzen */
StartSwitch (); /* Taster-Interrupt aktivieren */
FrontLED(ON);
LineData(data); /* Speichern von Helligkeitswert in data[0,1] */
Summe = data[0]+data[1]; /* Summe der Werte beider Fototransistoren */
while (1)
{
if (switched == 1) /* Wenn 1. Kollision, dann Rechtskurve 90° aus */
{
Firstcol();
for(i = 0; i < 25000; i++) /* Setze Zeitschlaufe für 2. Kollision */
{
if (switched == 1) /* Wenn 2. Kollision, dann Drehung 180° */
{
Secondcol();
for(i = 0; i < 25000; i++) /* Setze Zeitschlaufe für dritte Kollision */
{
if (switched == 1) /* Wenn 3. Kollision, dann Linksdrehung 90° */
{
Thirdcol();
}
else /* Keine 3. Kollision, Fahre normal */
{
Fahren();
}
}
}
else /* Keine 2. Kollision, Fahre normal */
{
Fahren();
}
}
}
else /* gar keine Kollision, Fahre normal, Stopp bei Linie */
{
LineData(data);
if(data[0]+data[1]+10 > Summe) /* Untergrundhelligkeitsdifferenz feststellen */
{
Fahren();
}
else
{
Disco(); /* Party gut - Alles gut */
while(1)
{} /* Endlosschleife - Ende des Programmes */
}
}
}
return 0;
}
Dieses habe ich mit Hilfe der neuen Lib abgeändert!
Code:
#include "asuro.h"
#include "myasuro.h"
#define FULL_L 200
#define FULL_R 215
volatile unsigned int i;
void Fahren(void) /* Vorwärts fahren */
{
StatusLED(GREEN);
BackLED(OFF,OFF);
MotorDir(FWD,FWD);
MotorSpeed(FULL_L,FULL_R);
}
void Anhalten(void) /* Anhalten */
{
StatusLED(RED);
BackLED(OFF,OFF);
MotorDir(BREAK,BREAK);
}
void Zurueck(void) /* Zurück fahren */
{
Encoder_Init();
Go(-50,200);
}
void KurveR(void) /* Kurve Rechts 90° */
{
Encoder_Init();
Turn(90,200);
}
void KurveL(void) /* Kurve rückwärts Rechts */
{
Encoder_Init();
Turn(-90,200);
}
void Drehung(void) /*180° Kurve*/
{
Turn(180,200);
}
void Firstcol(void) /* Programm Rechtskurve im Parcour 1. Kollision */
{
Anhalten();
Msleep(250);
Zurueck();
Msleep(15);
Anhalten();
Msleep(10);
KurveR();
Msleep(400);
Anhalten();
Msleep(250);
switched = 0;
StartSwitch ();
}
void Secondcol(void) /* Programm Linkskurve im Parcour, 2. Kollision */
{
Anhalten();
Msleep(250);
Zurueck();
Msleep(10);
Anhalten();
Msleep(250);
Drehung();
Msleep(355);
Anhalten();
Msleep(250);
Anhalten();
Msleep(250);
switched = 0;
StartSwitch();
}
void Thirdcol(void) /* Programm Sackgasse im Parcour, 3. Kollision */
{
Anhalten();
Msleep(250);
Zurueck();
Msleep(10);
KurveL();
Msleep(310);
Anhalten();
Msleep(250);
switched = 0;
StartSwitch();
}
void Disco(void) /* PARTYTIME! -15mal blinken/piepsen-*/
{
for(i = 0; i < 16; i++)
{
MotorDir(FWD,FWD);
MotorSpeed(50,50);
BackLED(OFF,OFF);
StatusLED(OFF);
FrontLED(OFF);
Msleep(200);
MotorDir(BREAK,BREAK);
BackLED(ON,ON);
StatusLED(RED);
FrontLED(ON);
Msleep(200);
}
}
int main (void) /* Hauptprogrammbeginn */
{
unsigned int data[2]; /* Speicherplpatz für Helligkeitswert */
unsigned int Summe;
Init ();
switched = 0; /* Kollisionserkennung auf 0 setzen */
StartSwitch (); /* Taster-Interrupt aktivieren */
FrontLED(ON);
LineData(data); /* Speichern von Helligkeitswert in data[0,1] */
Summe = data[0]+data[1]; /* Summe der Werte beider Fototransistoren */
while (1)
{
if (switched == 1) /* Wenn 1. Kollision, dann Rechtskurve 90° aus */
{
Firstcol();
for(i = 0; i < 25000; i++) /* Setze Zeitschlaufe für 2. Kollision */
{
if (switched == 1) /* Wenn 2. Kollision, dann Drehung 180° */
{
Secondcol();
for(i = 0; i < 25000; i++) /* Setze Zeitschlaufe für dritte Kollision */
{
if (switched == 1) /* Wenn 3. Kollision, dann Linksdrehung 90° */
{
Thirdcol();
}
else /* Keine 3. Kollision, Fahre normal */
{
Fahren();
}
}
}
else /* Keine 2. Kollision, Fahre normal */
{
Fahren();
}
}
}
else /* gar keine Kollision, Fahre normal, Stopp bei Linie */
{
LineData(data);
if(data[0]+data[1]+200 > Summe) /* Untergrundhelligkeitsdifferenz feststellen */
{
Fahren();
}
else
{
Disco(); /* Party gut - Alles gut */
while(1)
{} /* Endlosschleife - Ende des Programmes */
}
}
}
return 0;
}
So weit funktioniert auch noch alles bis auf das gerade aus fahren"void fahren (void)", da dies doch sehr Batterieabhängig ist.
Da die Go Funktion nicht unterbrochen werden kann, wollte ich dies durch eine Regelng mit Hilfe der Odometrie realisieren.
Nachdem ich diese Regelung wie folgt in das Labyrinth Programm eingebunden habe bekomme ich beim Compilieren die Fehlermeldung
"List Index Out of Bounds(249)"
Code:
#include "asuro.h"
#include "myasuro.h"
#define TRIGGERLEVEL 830
#define HYSTERESIS 10
#define LOW 0
#define HIGH 1
volatile unsigned int i;
void Fahren(void) /* Vorwärts fahren */
{
unsigned int data[2];
signed int status[2]={0,0};
signed int difference=0;
MotorDir(FWD, FWD);
while(Pollswitch()<1) {
// Helligkeitswerte der Lichtschranken auslesen
OdometrieData(data);
// Wechsel linker Sensor von niedrig auf hoch?
if ((status[0]==LOW) && (data[0]>TRIGGERLEVEL+HYSTERESIS)) {
status[0]=HIGH;
difference++;
}
// Wechsel linker Sensor von hoch auf niedrig?
if ((status[0]==HIGH) && (data[0]<TRIGGERLEVEL-HYSTERESIS)) {
status[0]=LOW;
difference++;
}
// Wechsel rechter Sensor von niedrig auf hoch?
if ((status[1]==LOW) && (data[1]>TRIGGERLEVEL+HYSTERESIS)) {
status[1]=HIGH;
difference--;
}
// Wechsel rechter Sensor von hoch auf niedrig?
if ((status[1]==HIGH) && (data[1]<TRIGGERLEVEL-HYSTERESIS)) {
status[1]=LOW;
difference--;
}
// zur Sicherheit: verhindern, dass der Differenzz?ler
// den erlaubten Wertebereich verl?st
if (difference<-255) difference=-255;
if (difference>255) difference=255;
// Status-LED noch entsprechend der erkannten Segmente
// aufleuchten lassen, grn fr links, rot fr rechts
StatusLED(status[0]+status[1]*2);
// Z?ldifferenz passend auf die Motoren verteilen
if (difference>0) MotorSpeed(160-difference,160);
else MotorSpeed(160,160+difference);
}
void Anhalten(void) /* Anhalten */
{
StatusLED(RED);
BackLED(OFF,OFF);
MotorDir(BREAK,BREAK);
}
void Zurueck(void) /* Zurück fahren */
{
Encoder_Init();
Go(-10,200);
}
void KurveR(void) /* Kurve Rechts 90° */
{
Encoder_Init();
Turn(60,200);
}
void KurveL(void) /* Kurve rückwärts Rechts */
{
Encoder_Init();
Turn(-50,200);
}
void Drehung(void) /*180° Kurve*/
{
Turn(120,200);
}
void Firstcol(void) /* Programm Rechtskurve im Parcour 1. Kollision */
{
Anhalten();
Msleep(250);
Zurueck();
Msleep(15);
Anhalten();
Msleep(10);
KurveR();
Msleep(400);
Anhalten();
Msleep(250);
switched = 0;
StartSwitch ();
}
void Secondcol(void) /* Programm Linkskurve im Parcour, 2. Kollision */
{
Anhalten();
Msleep(250);
Zurueck();
Msleep(10);
Anhalten();
Msleep(250);
Drehung();
Msleep(355);
Anhalten();
Msleep(250);
Anhalten();
Msleep(250);
switched = 0;
StartSwitch();
}
void Thirdcol(void) /* Programm Sackgasse im Parcour, 3. Kollision */
{
Anhalten();
Msleep(250);
Zurueck();
Msleep(10);
KurveL();
Msleep(310);
Anhalten();
Msleep(250);
switched = 0;
StartSwitch();
}
void Disco(void) /* PARTYTIME! -15mal blinken/piepsen-*/
{
for(i = 0; i < 16; i++)
{
MotorDir(FWD,FWD);
MotorSpeed(50,50);
BackLED(OFF,OFF);
StatusLED(OFF);
FrontLED(OFF);
Msleep(200);
MotorDir(BREAK,BREAK);
BackLED(ON,ON);
StatusLED(RED);
FrontLED(ON);
Msleep(200);
}
}
int main (void) /* Hauptprogrammbeginn */
{
unsigned int data[2]; /* Speicherplpatz für Helligkeitswert */
unsigned int Summe;
Init ();
switched = 0; /* Kollisionserkennung auf 0 setzen */
StartSwitch (); /* Taster-Interrupt aktivieren */
FrontLED(ON);
LineData(data); /* Speichern von Helligkeitswert in data[0,1] */
Summe = data[0]+data[1]; /* Summe der Werte beider Fototransistoren */
while (1)
{
if (switched == 1) /* Wenn 1. Kollision, dann Rechtskurve 90° aus */
{
Firstcol();
for(i = 0; i < 25000; i++) /* Setze Zeitschlaufe für 2. Kollision */
{
if (switched == 1) /* Wenn 2. Kollision, dann Drehung 180° */
{
Secondcol();
for(i = 0; i < 25000; i++) /* Setze Zeitschlaufe für dritte Kollision */
{
if (switched == 1) /* Wenn 3. Kollision, dann Linksdrehung 90° */
{
Thirdcol();
}
else /* Keine 3. Kollision, Fahre normal */
{
Fahren();
}
}
}
else /* Keine 2. Kollision, Fahre normal */
{
Fahren();
}
}
}
else /* gar keine Kollision, Fahre normal, Stopp bei Linie */
{
LineData(data);
if(data[0]+data[1]+200 > Summe) /* Untergrundhelligkeitsdifferenz feststellen */
{
Fahren();
}
else
{
Disco(); /* Party gut - Alles gut */
while(1)
{} /* Endlosschleife - Ende des Programmes */
}
}
}
return 0;
}
Beide Programme einzeln compiliert funzen ohne probleme!
Gibt es vll noch eine einfachere Möglichkeit den Asuro eine unbestimmte Strecke gerade aus fahren zu lassen bis eine Kollision erfolgt?
Ich steh jetzt nach 3 Tagen ständigem rumprobiern irgendwie mit dem Kopf an der Mauer. BITTE HELFT MIR!!!
MfG
GetzRazor
Hier noch der Text aus der Memo von Asuro Flash!
Code:
>Session Environment Variables:
AF_AVRDIR=C:\WinAVR-20090313
AF_PROJECT=LMAA
AF_SOURCE_FILES=asuro.c LMAA.c new.c
AF_ASM_SRC_FILES=
AF_PRGDIR=C:\Programme\AsuroFlash
AF_PRJDIR=C:\Dokumente und Einstellungen\All Users\Anwendungsdaten\AsuroFlash\Projects\LMAA
AF_LIB_PATH=C:\WinAVR-20090313\lib
File asuro.c saved.
File asuro.h saved.
File LMAA.c saved.
File myasuro.h saved.
>Default make_all.cmd file created.
>Default makefile created.
Make
set -e; avr-gcc -MM -mmcu=atmega8 -DF_CPU=8000000UL -I. -g -Os -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wall -Wstrict-prototypes -Wa,-ahlms=new.lst -IC:\Programme\AsuroFlash\include -IC:\WinAVR-20090313\lib\inc new.c \
| sed 's,\(.*\)\.o[ :]*,\1.o \1.d : ,g' > new.d; \
[ -s new.d ] || rm -f new.d
set -e; avr-gcc -MM -mmcu=atmega8 -DF_CPU=8000000UL -I. -g -Os -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wall -Wstrict-prototypes -Wa,-ahlms=LMAA.lst -IC:\Programme\AsuroFlash\include -IC:\WinAVR-20090313\lib\inc LMAA.c \
| sed 's,\(.*\)\.o[ :]*,\1.o \1.d : ,g' > LMAA.d; \
[ -s LMAA.d ] || rm -f LMAA.d
set -e; avr-gcc -MM -mmcu=atmega8 -DF_CPU=8000000UL -I. -g -Os -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wall -Wstrict-prototypes -Wa,-ahlms=asuro.lst -IC:\Programme\AsuroFlash\include -IC:\WinAVR-20090313\lib\inc asuro.c \
| sed 's,\(.*\)\.o[ :]*,\1.o \1.d : ,g' > asuro.d; \
[ -s asuro.d ] || rm -f asuro.d
-------- begin --------
avr-gcc --version
avr-gcc (GCC) 3.3.1
Copyright (C) 2003 Free Software Foundation, Inc.
This is free software; see the source for copying conditions. There is NO
warranty; not even for MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
Size before:
LMAA.elf :
section size addr
.text 2956 0
.data 16 8388704
.bss 32 8388720
.noinit 0 8388752
.eeprom 0 8454144
.stab 6012 0
.stabstr 2992 0
Total 12008
avr-gcc -c -mmcu=atmega8 -DF_CPU=8000000UL -I. -g -Os -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wall -Wstrict-prototypes -Wa,-ahlms=asuro.lst -IC:\Programme\AsuroFlash\include -IC:\WinAVR-20090313\lib\inc asuro.c -o asuro.o
avr-gcc -c -mmcu=atmega8 -DF_CPU=8000000UL -I. -g -Os -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wall -Wstrict-prototypes -Wa,-ahlms=LMAA.lst -IC:\Programme\AsuroFlash\include -IC:\WinAVR-20090313\lib\inc LMAA.c -o LMAA.o
LMAA.c: In function `Fahren':
LMAA.c:176: warning: `main' is normally a non-static function
LMAA.c:248: error: parse error at end of input
make: *** [LMAA.o] Error 1
C:\Dokumente und Einstellungen\All Users\Anwendungsdaten\AsuroFlash\Projects\LMAA>C:\WinAVR\utils\bin\make all
ExitCode 2
>Ready.
Problem mit "List index out of bounds" gelöst!
Hallo,
danke zunächst nochmal für eure Antworten.
Ich habe mittlerweile die neuesten Versionen installiert und zum laufen gebracht!
@Osser
Die Fehlermeldung "List index out of bounds" hat sich dadurch wirklich erledigt. Danke für den Hinweis!
@hai1991
Die Länge der Progs beträgt einzeln compiliert nur jeweils um die 45 Seiten.
Nun muss aber doch im Bereich der fahren Funktion noch ein Fehler sein!
Hier nochmal das Prog
Code:
#include "asuro.h"
#include "myasuro.h"
#define TRIGGERLEVEL 830
#define HYSTERESIS 10
#define LOW 0
#define HIGH 1
volatile unsigned int i;
void Fahren(void) /* Vorwärts fahren */
{
unsigned int data[2];
signed int status[2]={0,0};
signed int difference=0;
MotorDir(FWD, FWD);
while(PollSwitch()<1) {
// Helligkeitswerte der Lichtschranken auslesen
OdometrieData(data);
// Wechsel linker Sensor von niedrig auf hoch?
if ((status[0]==LOW) && (data[0]>TRIGGERLEVEL+HYSTERESIS)) {
status[0]=HIGH;
difference++;
}
// Wechsel linker Sensor von hoch auf niedrig?
if ((status[0]==HIGH) && (data[0]<TRIGGERLEVEL-HYSTERESIS)) {
status[0]=LOW;
difference++;
}
// Wechsel rechter Sensor von niedrig auf hoch?
if ((status[1]==LOW) && (data[1]>TRIGGERLEVEL+HYSTERESIS)) {
status[1]=HIGH;
difference--;
}
// Wechsel rechter Sensor von hoch auf niedrig?
if ((status[1]==HIGH) && (data[1]<TRIGGERLEVEL-HYSTERESIS)) {
status[1]=LOW;
difference--;
}
// zur Sicherheit: verhindern, dass der Differenzz?ler
// den erlaubten Wertebereich verl?st
if (difference<-255) difference=-255;
if (difference>255) difference=255;
// Status-LED noch entsprechend der erkannten Segmente
// aufleuchten lassen, grn fr links, rot fr rechts
StatusLED(status[0]+status[1]*2);
// Z?ldifferenz passend auf die Motoren verteilen
if (difference>0) MotorSpeed(160-difference,160);
else MotorSpeed(160,160+difference);
}
void Anhalten(void) /* Anhalten */
{
StatusLED(RED);
BackLED(OFF,OFF);
MotorDir(BREAK,BREAK);
}
void Zurueck(void) /* Zurück fahren */
{
Encoder_Init();
Go(-10,200);
}
void KurveR(void) /* Kurve Rechts 90° */
{
Encoder_Init();
Turn(60,200);
}
void KurveL(void) /* Kurve rückwärts Rechts */
{
Encoder_Init();
Turn(-50,200);
}
void Drehung(void) /*180° Kurve*/
{
Turn(120,200);
}
void Firstcol(void) /* Programm Rechtskurve im Parcour 1. Kollision */
{
Anhalten();
Msleep(250);
Zurueck();
Msleep(15);
Anhalten();
Msleep(10);
KurveR();
Msleep(400);
Anhalten();
Msleep(250);
switched = 0;
StartSwitch ();
}
void Secondcol(void) /* Programm Linkskurve im Parcour, 2. Kollision */
{
Anhalten();
Msleep(250);
Zurueck();
Msleep(10);
Anhalten();
Msleep(250);
Drehung();
Msleep(355);
Anhalten();
Msleep(250);
Anhalten();
Msleep(250);
switched = 0;
StartSwitch();
}
void Thirdcol(void) /* Programm Sackgasse im Parcour, 3. Kollision */
{
Anhalten();
Msleep(250);
Zurueck();
Msleep(10);
KurveL();
Msleep(310);
Anhalten();
Msleep(250);
switched = 0;
StartSwitch();
}
void Disco(void) /* PARTYTIME! -15mal blinken/piepsen-*/
{
for(i = 0; i < 16; i++)
{
MotorDir(FWD,FWD);
MotorSpeed(50,50);
BackLED(OFF,OFF);
StatusLED(OFF);
FrontLED(OFF);
Msleep(200);
MotorDir(BREAK,BREAK);
BackLED(ON,ON);
StatusLED(RED);
FrontLED(ON);
Msleep(200);
}
}
int main (void) /* Hauptprogrammbeginn */
{
unsigned int data[2]; /* Speicherplpatz für Helligkeitswert */
unsigned int Summe;
Init ();
switched = 0; /* Kollisionserkennung auf 0 setzen */
StartSwitch (); /* Taster-Interrupt aktivieren */
FrontLED(ON);
LineData(data); /* Speichern von Helligkeitswert in data[0,1] */
Summe = data[0]+data[1]; /* Summe der Werte beider Fototransistoren */
while (1)
{
if (switched == 1) /* Wenn 1. Kollision, dann Rechtskurve 90° aus */
{
Firstcol();
for(i = 0; i < 25000; i++) /* Setze Zeitschlaufe für 2. Kollision */
{
if (switched == 1) /* Wenn 2. Kollision, dann Drehung 180° */
{
Secondcol();
for(i = 0; i < 25000; i++) /* Setze Zeitschlaufe für dritte Kollision */
{
if (switched == 1) /* Wenn 3. Kollision, dann Linksdrehung 90° */
{
Thirdcol();
}
else /* Keine 3. Kollision, Fahre normal */
{
Fahren();
}
}
}
else /* Keine 2. Kollision, Fahre normal */
{
Fahren();
}
}
}
else /* gar keine Kollision, Fahre normal, Stopp bei Linie */
{
LineData(data);
if(data[0]+data[1]+200 > Summe) /* Untergrundhelligkeitsdifferenz feststellen */
{
Fahren();
}
else
{
Disco(); /* Party gut - Alles gut */
while(1)
{} /* Endlosschleife - Ende des Programmes */
}
}
}
return 0;
}
und das entsprechende Memo
Code:
>Session Environment Variables:
AF_AVRDIR=C:\WinAVR-20090306rc1
AF_PROJECT=Labyrinth
AF_SOURCE_FILES=asuro.c Labyrinth.c
AF_ASM_SRC_FILES=
AF_PRGDIR=C:\Program Files (x86)\AsuroFlash
AF_PRJDIR=C:\Documents and Settings\Administrator\Desktop\Asuro\Projekte\LMAA
AF_LIB_PATH=C:\AsuroLib
File asuro.c saved.
File asuro.h saved.
File myasuro.h saved.
File Labyrinth.c saved.
>Default make_all.cmd file created.
>Default makefile created.
Make
C:\Documents and Settings\Administrator\Desktop\Asuro\Projekte\LMAA>C:\WinAVR-20090306rc1\utils\bin\make all
set -e; avr-gcc -MM -mmcu=atmega8 -DF_CPU=8000000UL -I. -g -Os -I"C:\AsuroLib/inc" -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wall -Wstrict-prototypes -Wa,-ahlms="Labyrinth.lst" "Labyrinth.c" \
| sed 's,\(.*\)\.o[ :]*,\1.o \1.d : ,g' > "Labyrinth.d"; \
[ -s Labyrinth.d ] || rm -f "Labyrinth.d"
set -e; avr-gcc -MM -mmcu=atmega8 -DF_CPU=8000000UL -I. -g -Os -I"C:\AsuroLib/inc" -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wall -Wstrict-prototypes -Wa,-ahlms="asuro.lst" "asuro.c" \
| sed 's,\(.*\)\.o[ :]*,\1.o \1.d : ,g' > "asuro.d"; \
[ -s asuro.d ] || rm -f "asuro.d"
-------- begin --------
avr-gcc --version
avr-gcc (WinAVR 20090306rc1) 4.3.2
Copyright (C) 2008 Free Software Foundation, Inc.
This is free software; see the source for copying conditions. There is NO
warranty; not even for MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
avr-gcc -c -mmcu=atmega8 -DF_CPU=8000000UL -I. -g -Os -I"C:\AsuroLib/inc" -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wall -Wstrict-prototypes -Wa,-ahlms="asuro.lst" "asuro.c" -o asuro.o
In file included from asuro.h:147,
from asuro.c:137:
c:/winavr-20090306rc1/lib/gcc/../../avr/include/avr/signal.h:36:2: warning: #warning "This header file is obsolete. Use <avr/interrupt.h>."
asuro.c: In function 'PrintInt':
asuro.c:482: warning: pointer targets in passing argument 1 of 'SerWrite' differ in signedness
avr-gcc -c -mmcu=atmega8 -DF_CPU=8000000UL -I. -g -Os -I"C:\AsuroLib/inc" -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wall -Wstrict-prototypes -Wa,-ahlms="Labyrinth.lst" "Labyrinth.c" -o Labyrinth.o
In file included from asuro.h:147,
from Labyrinth.c:1:
c:/winavr-20090306rc1/lib/gcc/../../avr/include/avr/signal.h:36:2: warning: #warning "This header file is obsolete. Use <avr/interrupt.h>."
Labyrinth.c: In function 'Fahren':
Labyrinth.c:175: warning: 'main' is normally a non-static function
Labyrinth.c:247: error: expected declaration or statement at end of input
make: *** [Labyrinth.o] Error 1
ExitCode 2
>Ready.
MfG
G3tzR@zor
Edit
Habe nun auch den Fehler im Programm gefunden!
In der fahren Funktion hat am Ende noch eine geschlossene, geschweifte Klammer gefehlt, wodurch natürlich der ganze rest des Programms mit eingebunden war.
So weit so gut, hab mich schon gefreut, dass es endlich geht und hab das Prog gleich mal auf meinen Asuro geflasht.
Nun fährt er, warum auch immer, nur noch rückwärts, die StatusLED leuchtet Rot und er reagiert auf keinen Taster.
Habt ihr habt eine Idee was nun an meinem Prog noch falsch ist.
Hier mal der fast funktionierende Code
Code:
#include "asuro.h"
#include "myasuro.h"
#define TRIGGERLEVEL 830
#define HYSTERESIS 10
#define LOW 0
#define HIGH 1
volatile unsigned int i;
void Fahren(void) /* Vorwärts fahren */
{
unsigned int data[2];
signed int status[2]={0,0};
signed int difference=0;
MotorDir(FWD, FWD);
while(PollSwitch()<1) {
// Helligkeitswerte der Lichtschranken auslesen
OdometrieData(data);
// Wechsel linker Sensor von niedrig auf hoch?
if ((status[0]==LOW) && (data[0]>TRIGGERLEVEL+HYSTERESIS)) {
status[0]=HIGH;
difference++;
}
// Wechsel linker Sensor von hoch auf niedrig?
if ((status[0]==HIGH) && (data[0]<TRIGGERLEVEL-HYSTERESIS)) {
status[0]=LOW;
difference++;
}
// Wechsel rechter Sensor von niedrig auf hoch?
if ((status[1]==LOW) && (data[1]>TRIGGERLEVEL+HYSTERESIS)) {
status[1]=HIGH;
difference--;
}
// Wechsel rechter Sensor von hoch auf niedrig?
if ((status[1]==HIGH) && (data[1]<TRIGGERLEVEL-HYSTERESIS)) {
status[1]=LOW;
difference--;
}
// zur Sicherheit: verhindern, dass der Differenzz?ler
// den erlaubten Wertebereich verl?st
if (difference<-255) difference=-255;
if (difference>255) difference=255;
// Status-LED noch entsprechend der erkannten Segmente
// aufleuchten lassen, grn fr links, rot fr rechts
StatusLED(status[0]+status[1]*2);
// Z?ldifferenz passend auf die Motoren verteilen
if (difference>0) MotorSpeed(180-difference,180);
else MotorSpeed(180,180+difference);
}
}
void Anhalten(void) /* Anhalten */
{
StatusLED(RED);
BackLED(OFF,OFF);
MotorDir(BREAK,BREAK);
}
void Zurueck(void) /* Zurück fahren */
{
Encoder_Init();
Go(-10,200);
}
void KurveR(void) /* Kurve Rechts 90° */
{
Encoder_Init();
Turn(60,200);
}
void KurveL(void) /* Kurve rückwärts Rechts */
{
Encoder_Init();
Turn(-50,200);
}
void Drehung(void) /*180° Kurve*/
{
Turn(120,200);
}
void Firstcol(void) /* Programm Rechtskurve im Parcour 1. Kollision */
{
Anhalten();
Msleep(250);
Zurueck();
Msleep(15);
Anhalten();
Msleep(10);
KurveR();
Msleep(400);
Anhalten();
Msleep(250);
switched = 0;
StartSwitch ();
}
void Secondcol(void) /* Programm Linkskurve im Parcour, 2. Kollision */
{
Anhalten();
Msleep(250);
Zurueck();
Msleep(10);
Anhalten();
Msleep(250);
Drehung();
Msleep(355);
Anhalten();
Msleep(250);
Anhalten();
Msleep(250);
switched = 0;
StartSwitch();
}
void Thirdcol(void) /* Programm Sackgasse im Parcour, 3. Kollision */
{
Anhalten();
Msleep(250);
Zurueck();
Msleep(10);
KurveL();
Msleep(310);
Anhalten();
Msleep(250);
switched = 0;
StartSwitch();
}
void Disco(void) /* PARTYTIME! -15mal blinken/piepsen-*/
{
for(i = 0; i < 16; i++)
{
MotorDir(FWD,FWD);
MotorSpeed(50,50);
BackLED(OFF,OFF);
StatusLED(OFF);
FrontLED(OFF);
Msleep(200);
MotorDir(BREAK,BREAK);
BackLED(ON,ON);
StatusLED(RED);
FrontLED(ON);
Msleep(200);
}
}
int main (void) /* Hauptprogrammbeginn */
{
unsigned int data[2]; /* Speicherplpatz für Helligkeitswert */
unsigned int Summe;
Init ();
switched = 0; /* Kollisionserkennung auf 0 setzen */
StartSwitch (); /* Taster-Interrupt aktivieren */
FrontLED(ON);
LineData(data); /* Speichern von Helligkeitswert in data[0,1] */
Summe = data[0]+data[1]; /* Summe der Werte beider Fototransistoren */
while (1)
{
if (switched == 1) /* Wenn 1. Kollision, dann Rechtskurve 90° aus */
{
Firstcol();
for(i = 0; i < 25000; i++) /* Setze Zeitschlaufe für 2. Kollision */
{
if (switched == 1) /* Wenn 2. Kollision, dann Drehung 180° */
{
Secondcol();
for(i = 0; i < 25000; i++) /* Setze Zeitschlaufe für dritte Kollision */
{
if (switched == 1) /* Wenn 3. Kollision, dann Linksdrehung 90° */
{
Thirdcol();
}
else /* Keine 3. Kollision, Fahre normal */
{
Fahren();
}
}
}
else /* Keine 2. Kollision, Fahre normal */
{
Fahren();
}
}
}
else /* gar keine Kollision, Fahre normal, Stopp bei Linie */
{
LineData(data);
if(data[0]+data[1]+200 > Summe) /* Untergrundhelligkeitsdifferenz feststellen */
{
Fahren();
}
else
{
Disco(); /* Party gut - Alles gut */
while(1)
{} /* Endlosschleife - Ende des Programmes */
}
}
}
return 0;
}
Danke schonmal im Vorraus für eure Hilfe!
MfG
G3tzR@zor[/code]
Liste der Anhänge anzeigen (Anzahl: 2)
Ich bin so langsam wirklich am Verzweifeln. Ich habe nun Versucht die Pollswitch abfrage so einzubauen.
Code:
#include "asuro.h"
#include "myasuro.h"
#define TRIGGERLEVEL 830
#define HYSTERESIS 10
#define LOW 0
#define HIGH 1
volatile unsigned int i;
void Fahren(void) /* Vorwärts fahren */
{
unsigned char taste1, taste2;
unsigned int data[2];
signed int status[2]={0,0};
signed int difference=0;
MotorDir(FWD, FWD);
while((taste1<1) && (taste1==taste2)) {
taste1 = PollSwitch();
taste2 = PollSwitch();
// Helligkeitswerte der Lichtschranken auslesen
OdometrieData(data);
// Wechsel linker Sensor von niedrig auf hoch?
if ((status[0]==LOW) && (data[0]>TRIGGERLEVEL+HYSTERESIS)) {
status[0]=HIGH;
difference++;
}
// Wechsel linker Sensor von hoch auf niedrig?
if ((status[0]==HIGH) && (data[0]<TRIGGERLEVEL-HYSTERESIS)) {
status[0]=LOW;
difference++;
}
// Wechsel rechter Sensor von niedrig auf hoch?
if ((status[1]==LOW) && (data[1]>TRIGGERLEVEL+HYSTERESIS)) {
status[1]=HIGH;
difference--;
}
// Wechsel rechter Sensor von hoch auf niedrig?
if ((status[1]==HIGH) && (data[1]<TRIGGERLEVEL-HYSTERESIS)) {
status[1]=LOW;
difference--;
}
// zur Sicherheit: verhindern, dass der Differenzz?ler
// den erlaubten Wertebereich verl?st
if (difference<-255) difference=-255;
if (difference>255) difference=255;
// Status-LED noch entsprechend der erkannten Segmente
// aufleuchten lassen, grn fr links, rot fr rechts
StatusLED(status[0]+status[1]*2);
// Z?ldifferenz passend auf die Motoren verteilen
if (difference>0) MotorSpeed(180-difference,180);
else MotorSpeed(180,180+difference);
}
}
void Anhalten(void) /* Anhalten */
{
StatusLED(RED);
BackLED(OFF,OFF);
MotorDir(BREAK,BREAK);
}
void Zurueck(void) /* Zurück fahren */
{
Encoder_Init();
Go(-10,200);
}
void KurveR(void) /* Kurve Rechts 90° */
{
Encoder_Init();
Turn(60,200);
}
void KurveL(void) /* Kurve rückwärts Rechts */
{
Encoder_Init();
Turn(-50,200);
}
void Drehung(void) /*180° Kurve*/
{
Turn(120,200);
}
void Firstcol(void) /* Programm Rechtskurve im Parcour 1. Kollision */
{
Anhalten();
Msleep(250);
Zurueck();
Msleep(15);
Anhalten();
Msleep(10);
KurveR();
Msleep(400);
Anhalten();
Msleep(250);
switched = 0;
StartSwitch ();
}
void Secondcol(void) /* Programm Linkskurve im Parcour, 2. Kollision */
{
Anhalten();
Msleep(250);
Zurueck();
Msleep(10);
Anhalten();
Msleep(250);
Drehung();
Msleep(355);
Anhalten();
Msleep(250);
Anhalten();
Msleep(250);
switched = 0;
StartSwitch();
}
void Thirdcol(void) /* Programm Sackgasse im Parcour, 3. Kollision */
{
Anhalten();
Msleep(250);
Zurueck();
Msleep(10);
KurveL();
Msleep(310);
Anhalten();
Msleep(250);
switched = 0;
StartSwitch();
}
void Disco(void) /* PARTYTIME! -15mal blinken/piepsen-*/
{
for(i = 0; i < 16; i++)
{
MotorDir(FWD,FWD);
MotorSpeed(50,50);
BackLED(OFF,OFF);
StatusLED(OFF);
FrontLED(OFF);
Msleep(200);
MotorDir(BREAK,BREAK);
BackLED(ON,ON);
StatusLED(RED);
FrontLED(ON);
Msleep(200);
}
}
int main (void) /* Hauptprogrammbeginn */
{
unsigned int data[2]; /* Speicherplpatz für Helligkeitswert */
unsigned int Summe;
Init ();
switched = 0; /* Kollisionserkennung auf 0 setzen */
StartSwitch (); /* Taster-Interrupt aktivieren */
FrontLED(ON);
LineData(data); /* Speichern von Helligkeitswert in data[0,1] */
Summe = data[0]+data[1]; /* Summe der Werte beider Fototransistoren */
while (1)
{
if (switched == 1) /* Wenn 1. Kollision, dann Rechtskurve 90° aus */
{
Firstcol();
for(i = 0; i < 25000; i++) /* Setze Zeitschlaufe für 2. Kollision */
{
if (switched == 1) /* Wenn 2. Kollision, dann Drehung 180° */
{
Secondcol();
for(i = 0; i < 25000; i++) /* Setze Zeitschlaufe für dritte Kollision */
{
if (switched == 1) /* Wenn 3. Kollision, dann Linksdrehung 90° */
{
Thirdcol();
}
else /* Keine 3. Kollision, Fahre normal */
{
Fahren();
}
}
}
else /* Keine 2. Kollision, Fahre normal */
{
Fahren();
}
}
}
else /* gar keine Kollision, Fahre normal, Stopp bei Linie */
{
LineData(data);
if(data[0]+data[1]+200 > Summe) /* Untergrundhelligkeitsdifferenz feststellen */
{
Fahren();
}
else
{
Disco(); /* Party gut - Alles gut */
while(1)
{} /* Endlosschleife - Ende des Programmes */
}
}
}
return 0;
}
Nun leuchtet die StatusLED Grün und die LED für die Linensensoren.
Setze ich das eine taster1=PollSwitch() vor die while schleife fährt der Ausuro nur noch Rückwärts bei roter StatusLED und leuchtender LiniensensorLED. Er nimmt auch keine Pollswitch anweisung mehr an.
Code:
#include "asuro.h"
#include "myasuro.h"
#define TRIGGERLEVEL 830
#define HYSTERESIS 10
#define LOW 0
#define HIGH 1
volatile unsigned int i;
void Fahren(void) /* Vorwärts fahren */
{
unsigned char taste1, taste2;
unsigned int data[2];
signed int status[2]={0,0};
signed int difference=0;
MotorDir(FWD, FWD);
taste1 = PollSwitch();
while((taste1<1) && (taste1==taste2)) {
taste2 = PollSwitch();
// Helligkeitswerte der Lichtschranken auslesen
OdometrieData(data);
// Wechsel linker Sensor von niedrig auf hoch?
if ((status[0]==LOW) && (data[0]>TRIGGERLEVEL+HYSTERESIS)) {
status[0]=HIGH;
difference++;
}
// Wechsel linker Sensor von hoch auf niedrig?
if ((status[0]==HIGH) && (data[0]<TRIGGERLEVEL-HYSTERESIS)) {
status[0]=LOW;
difference++;
}
// Wechsel rechter Sensor von niedrig auf hoch?
if ((status[1]==LOW) && (data[1]>TRIGGERLEVEL+HYSTERESIS)) {
status[1]=HIGH;
difference--;
}
// Wechsel rechter Sensor von hoch auf niedrig?
if ((status[1]==HIGH) && (data[1]<TRIGGERLEVEL-HYSTERESIS)) {
status[1]=LOW;
difference--;
}
// zur Sicherheit: verhindern, dass der Differenzz?ler
// den erlaubten Wertebereich verl?st
if (difference<-255) difference=-255;
if (difference>255) difference=255;
// Status-LED noch entsprechend der erkannten Segmente
// aufleuchten lassen, grn fr links, rot fr rechts
StatusLED(status[0]+status[1]*2);
// Z?ldifferenz passend auf die Motoren verteilen
if (difference>0) MotorSpeed(180-difference,180);
else MotorSpeed(180,180+difference);
}
}
void Anhalten(void) /* Anhalten */
{
StatusLED(RED);
BackLED(OFF,OFF);
MotorDir(BREAK,BREAK);
}
void Zurueck(void) /* Zurück fahren */
{
Encoder_Init();
Go(-10,200);
}
void KurveR(void) /* Kurve Rechts 90° */
{
Encoder_Init();
Turn(60,200);
}
void KurveL(void) /* Kurve rückwärts Rechts */
{
Encoder_Init();
Turn(-50,200);
}
void Drehung(void) /*180° Kurve*/
{
Turn(120,200);
}
void Firstcol(void) /* Programm Rechtskurve im Parcour 1. Kollision */
{
Anhalten();
Msleep(250);
Zurueck();
Msleep(15);
Anhalten();
Msleep(10);
KurveR();
Msleep(400);
Anhalten();
Msleep(250);
switched = 0;
StartSwitch ();
}
void Secondcol(void) /* Programm Linkskurve im Parcour, 2. Kollision */
{
Anhalten();
Msleep(250);
Zurueck();
Msleep(10);
Anhalten();
Msleep(250);
Drehung();
Msleep(355);
Anhalten();
Msleep(250);
Anhalten();
Msleep(250);
switched = 0;
StartSwitch();
}
void Thirdcol(void) /* Programm Sackgasse im Parcour, 3. Kollision */
{
Anhalten();
Msleep(250);
Zurueck();
Msleep(10);
KurveL();
Msleep(310);
Anhalten();
Msleep(250);
switched = 0;
StartSwitch();
}
void Disco(void) /* PARTYTIME! -15mal blinken/piepsen-*/
{
for(i = 0; i < 16; i++)
{
MotorDir(FWD,FWD);
MotorSpeed(50,50);
BackLED(OFF,OFF);
StatusLED(OFF);
FrontLED(OFF);
Msleep(200);
MotorDir(BREAK,BREAK);
BackLED(ON,ON);
StatusLED(RED);
FrontLED(ON);
Msleep(200);
}
}
int main (void) /* Hauptprogrammbeginn */
{
unsigned int data[2]; /* Speicherplpatz für Helligkeitswert */
unsigned int Summe;
Init ();
switched = 0; /* Kollisionserkennung auf 0 setzen */
StartSwitch (); /* Taster-Interrupt aktivieren */
FrontLED(ON);
LineData(data); /* Speichern von Helligkeitswert in data[0,1] */
Summe = data[0]+data[1]; /* Summe der Werte beider Fototransistoren */
while (1)
{
if (switched == 1) /* Wenn 1. Kollision, dann Rechtskurve 90° aus */
{
Firstcol();
for(i = 0; i < 25000; i++) /* Setze Zeitschlaufe für 2. Kollision */
{
if (switched == 1) /* Wenn 2. Kollision, dann Drehung 180° */
{
Secondcol();
for(i = 0; i < 25000; i++) /* Setze Zeitschlaufe für dritte Kollision */
{
if (switched == 1) /* Wenn 3. Kollision, dann Linksdrehung 90° */
{
Thirdcol();
}
else /* Keine 3. Kollision, Fahre normal */
{
Fahren();
}
}
}
else /* Keine 2. Kollision, Fahre normal */
{
Fahren();
}
}
}
else /* gar keine Kollision, Fahre normal, Stopp bei Linie */
{
LineData(data);
if(data[0]+data[1]+200 > Summe) /* Untergrundhelligkeitsdifferenz feststellen */
{
Fahren();
}
else
{
Disco(); /* Party gut - Alles gut */
while(1)
{} /* Endlosschleife - Ende des Programmes */
}
}
}
return 0;
}
Warum fährt er Rückwärts? Dies ist doch im ganzen Programm nicht vorgesehen, bis auf dieses kurz zurück bei einer Kollision.
Hier mal die beiden Hex files zu den Codes. Vll könnt ihr sie bei eurem Asuro mal testen.
Liste der Anhänge anzeigen (Anzahl: 2)
Hi...hier bin ich mal wieder. Da die Noten für das Projekt nun fest stehen kann ich nun den Code posten.
Code:
/***************************Bibliotheken einbinden*****************************/
#include "asuro.h"
#include "myasuro.h"
/*******************Defines und Variablen für Fahren Regelung******************/
unsigned int data[2]; //Speicherplatz für Odometriedaten bereitstellen
signed int status[2]={0,0}; // Variable zur Bestimmung der Hell/Dunkel wechsel
signed int difference=0; // Variable zur regelung der Motorgeschwindigkeit
#define TRIGGERLEVEL 650 //Schwellwert für Hell/Dunkel übergänge
#define HYSTERESIS 10 // Ausgleich von Messfehlern
#define LOW 0 // Definition für Dunkel
#define HIGH 1 // Definition für Hell
#define keine_taste (PINC & (1<<PC4)) //Taster direkt abfragen
/************Variablen für Zeitvorgaben zwischen den Kollisionen***************/
unsigned long meineZeit;
unsigned long meineZeit2;
/**************Speicherplatz für Liniendaten bereitstellen*********************/
unsigned int umgebung[1];
/***Variable für Dunkelerkennung, damit der Asruro im Dunkeln stehen bleibt****/
int dunkel;
/**************************Vorwärts fahren*************************************/
void Fahren(void)
{
// Prozessor neu initialieren um EncoderInit() zurückzusetzen
// da sonst die Regelung nicht mehr funktioniert
Init();
FrontLED(ON);
;
//Motor Drehrichtung bestimmen
MotorDir(FWD, FWD);
// so lange gerade aus fahren bis ein Taster gedrückt wird
// und es hell genug ist
while((keine_taste) && (umgebung[0]>1))
{
LineData(umgebung);
// Helligkeitswerte der Lichtschranken auslesen
OdometrieData(data);
// Wechsel linker Sensor von niedrig auf hoch?
if ((status[0]==LOW) && (data[0]>TRIGGERLEVEL+HYSTERESIS)) {
status[0]=HIGH;
difference++;
}
// Wechsel linker Sensor von hoch auf niedrig?
if ((status[0]==HIGH) && (data[0]<TRIGGERLEVEL-HYSTERESIS)) {
status[0]=LOW;
difference++;
}
// Wechsel rechter Sensor von niedrig auf hoch?
if ((status[1]==LOW) && (data[1]>TRIGGERLEVEL+HYSTERESIS)) {
status[1]=HIGH;
difference--;
}
// Wechsel rechter Sensor von hoch auf niedrig?
if ((status[1]==HIGH) && (data[1]<TRIGGERLEVEL-HYSTERESIS)) {
status[1]=LOW;
difference--;
}
// zur Sicherheit: verhindern, dass der Differenzzäler
// den erlaubten Wertebereich verlässt
if (difference<-255) difference=-255;
if (difference>255) difference=255;
// Status-LED noch entsprechend der erkannten Segmente
// aufleuchten lassen, grun für links, rot für rechts
StatusLED(status[0]+status[1]*2);
// Zäldifferenz passend auf die Motoren verteilen
if (difference>0) MotorSpeed(190-difference,190);
else MotorSpeed(190,190+difference);
}
Dunkel ();
}
/********Einzelfunktionen für Verarbeitung in First-,Second und Thirdcol********/
void Anhalten(void) /* Anhalten */
{
StatusLED(RED);
BackLED(OFF,OFF);
MotorDir(BREAK,BREAK);
}
void Zurueck(void) /* 20mm Zurück fahren */
{
EncoderInit();
GoTurn(-40,0,200);
}
void KurveR(void) /* 90° Kurve Rechts */
{
EncoderInit();
GoTurn(0,90,200);
}
void KurveL(void) /* 90° Kurve Links */
{
EncoderInit();
GoTurn(0,-90,200);
}
void Drehung(void) /*180° Drehung*/
{
EncoderInit();
GoTurn(0,180,200);
}
/****************Programm Rechtskurve im Parcour 1. Kollision******************/
void Firstcol(void)
{
Anhalten();
Msleep(250);
Zurueck();
Anhalten();
Msleep(10);
KurveR();
Anhalten();
Msleep(250);
meineZeit=Gettime(); //Aktuelle Prozessorzeit für Kollisionserkennung
//in meineZeit speichern
switched = 0;
StartSwitch ();
}
/*****************Programm Linkskurve im Parcour, 2. Kollision*****************/
void Secondcol(void)
{
Anhalten();
Msleep(250);
Zurueck();
Anhalten();
Msleep(250);
Drehung();
Anhalten();
Msleep(250);
meineZeit2=Gettime(); //Aktuelle Prozessorzeit für Kollisionserkennung
// in meineZeit2 speichern
switched = 0; // Kollisionserkennung auf 0 setzen
StartSwitch(); // Taster-Interrupt aktivieren
}
/*****************Programm Sackgasse im Parcour, 3. Kollision******************/
void Thirdcol(void)
{
Anhalten();
Msleep(250);
Zurueck();
KurveL();
Anhalten();
Msleep(250);
switched = 0; // Kollisionserkennung auf 0 setzen
StartSwitch(); // Taster-Interrupt aktivieren
}
/******Abfrage der Liniensensoren um Helligkeit der Umgebung festzustellen*****/
void Dunkel (void)
{
LineData(umgebung);
if (umgebung[0]<1)
{
dunkel = 1;
}
else if(umgebung[0]>1)
{
dunkel = 0;
}
}
/*****Wird ausgeführt, wenn der Asuro das ende des Labyrinths erreicht hat!****/
/*******Ende des Labyrints muss durch eine Einhausung abgedunkelt werden!******/
void Ziel(void)
{
int i;
for(i = 0; i < 16; i++) /* Asuro steht im Dunkeln, Ziel erreicht*/
{
MotorDir(FWD,FWD);
MotorSpeed(50,50);
BackLED(OFF,OFF);
StatusLED(OFF);
FrontLED(OFF);
Msleep(200);
MotorDir(BREAK,BREAK);
BackLED(ON,ON);
StatusLED(RED);
FrontLED(ON);
Msleep(200);
}
dunkel=0;
}
/*****************************Hauptprogrammbeginn******************************/
int main (void)
{
Init (); // Prozessor initialisieren
StatusLED(RED); // 3 Sekunden Countdown zum Start,
Msleep(1000);
StatusLED(YELLOW); // Status Led wird im Sekundentakt
Msleep(1000);
StatusLED(GREEN); // von Rot über Gelb zu Grün geschaltet
Msleep(1000);
FrontLED(ON);
switched = 0; // Kollisionserkennung auf 0 setzen
StartSwitch (); // Taster-Interrupt aktivieren
/********************Endlosschleife für Zustandsabfrage************************/
while(1)
{
/******************Wenn 1. Kollision, dann Rechtskurve 90°*********************/
if ((switched == 1)&&(Gettime()>meineZeit+1000)&&(Gettime()>meineZeit2+600))
{
Firstcol();
}
/*********Wenn 2. Kollision innerhalb 1s nach abarbeitung von Firstcol*******/
else if ((switched == 1)&&(Gettime()<meineZeit+1000))
{
Secondcol();
}
/********Wenn 3. Kollision innerhalb 0,6s nach abarbeitung von Secondcol*******/
else if ((switched == 1)&&(Gettime()<meineZeit2+600))
{
Thirdcol();
}
/**************************Wenn umgebung zu dunkel*****************************/
else if(dunkel==1)
{
Ziel();
}
/*********************Wenn keine Kollision, Fahre normal***********************/
else
{
Fahren();
}
}
/*********************Endlosschleife - Ende des Programmes*********************/
/*****Um zu verhindern, dass eventuell alte Programmteile aufgerufen werden****/
/*********************die sich noch im Speicher befinden***********************/
while(1);
return 0;
}
Folgende Dinge müsst ihr beim Bau des Labyriths beachten!!!
1. Es muss rechtwinklig aufgebaut sein
2. Bei Sackgassen muss der Lösungsweg gegenüber der Sackgasse liegen
Bei Meinem Asuro hab ich folgendes verbessert:
1. Odometriesensoren abgedunkelt mit schwarzem Papier
2. Die Odometriescheiben(12er) habe ich mit hilfe von Kabelisolierung, die ich über die Welle geschoben habe befestigt um den Abstand zu den Sensoren gleich zu halten.
Hab euch noch 2 Bilder von den Verbesserungen und das .hex file gepostet und ein kleines Video bei Youtube hoch geladen.
Videolink: http://www.youtube.com/watch?v=JB6F8HWTHLE
So nun wünsch ich euch viel Spass und Erfolg mit dem Code.
P.S. Das Programm funktioniert nur mit der aktuellen, erweiterten Lib aus dem Roboternetz Forum.
Ein großes danke Schön an die, die die Lib entwickeln, einfach spitze was ihr da mittlerweile auf die Beine gestellt habt.
Gruß
G3tzR@zor