Das Problem hab ich jetzt selbst lösen können. Die Variable moved war falsch deklariert.
Code:' Sascha Kröger ' 09.03.2004 ' Programm Strecke2.bas ' ' --------------------------------------------------------------------- ' FUNKTION DES PROGRAMMS '---------------------------------------------------------------------- ' In diesem einfachen Beispiel wird der Roboter gestartet und fährt eine Strecke ' entsprechen den Wert von MAX_LENGTH. Wenn der Roboter die Strecke zurück- ' gelegt hat wird kurz auf den vier LEDs ein Lauflicht dargestellt. Anschließend ' fährt der Roboter die zuvor zurückgelegte strecke rückwärts wieder zurück. ' Wenn der Roboter beim vorwärts fahren auf ein Hindernis trifft, dann stoppt er ' gibt zweimal ein akustisches Signal aus und läst dann die vier LEDS alle ' ein paar mal Blicken. Anschließend fährt der Roboter die zuvor ' zurückgelegte strecke rückwärts wieder zurück. '------------------------------------------------------------------------ '-------------------------- '------ I/O PORTS --------- '-------------------------- '- INTERFACE LCD/EXTPORT -- define sdio port[1] define sclio port[3] define strobe port[4] '-- INTERFACE COM/NAV ----- define DATALINE port[1] define CLOCKLINE port[2] '-------------------------- '------ SENSORS --------- '-------------------------- define LIGHT_L ad[7] define LIGHT_R ad[6] define SYS_VOLTS ad[3] define CHRG_CURRENT ad[2] define SYS_CURRENT ad[1] define MIC ad[4] define TOUCH ad[5] '--------------------------- '------ DRIVE ------------- '--------------------------- define SPEED_L da[1] define SPEED_R da[2] define REV_L port[6] define REV_R port[5] '-------------------------- '---- SYSTEM MEMORY ------- '-------------------------- '--- INTERFACE BUFFER ---- define LBYTE byte[1] define HBYTE byte[2] define SUBCMD byte[3] '---- OPERATION DATA ------ define EXTPORT byte[4] define LED1_F bit[29] define LED2_F bit[30] define LED3_F bit[31] define LED4_F bit[32] define SYSTEM_STATUS byte[5] define ACSL_F bit[33] define ACSR_F bit[34] define IR_F bit[35] '-------------------------- '---- USER MEMORY ------- '-------------------------- define GP byte[6] define MAXLIGHT byte[7] define GP1 byte[8] '--- SYSTEMROUTINEN ----------- define PLM_SLOW &H01C4 define SYSTEM &H01C9 define COMNAV &H0154 '- ERWEITERTE SYSTEM ROUTINEN - define REVR &H0101 'ANTRIEB RECHTS RÜCKWÄRTS define REVL &H0106 'ANTRIEB LINKS RÜCKWÄRTS define FWDR &H010B 'ANTRIEG RECHTS VORWÄRTS define FWDL &H0110 'ANTRIEB LINKS VORWÄRTS define ROTR &H0115 'RECHTS DREHEN define ROTL &H0119 'LINKS DREHEN define REV &H011D 'RÜCKWÄRTS define FWD &H0121 'VORWÄRTS define COMNAV_STATUS &H0125 'UPDATED ALLE FLAGS IM STATUS-REGISTER define ACS_LO &H01E1 'ACS POWER LO define ACS_HI &H01E9 ' define ACS_MAX &H01F1 ' define SEND_TLM &H014A 'SENDET TELEMETRIE (CH=HBYTE,DATEN=LBYTE) define SEND_SPEEDR &H0134 'SENDET TLM KANAL 8,PLM RECHTS define SEND_SPEEDL &H013A 'SENDET TLM KANAL 7,PLM LINKS define SEND_SYSSTAT &H0144 'SENDET TLM KANAL 0,SYSTEM STATUS '(FLAGS für ACS,FWD/REV, ACS_LO/HI/MAX) '------------------------------------------------------------------------------- define MAX_LENGTH 20 ' Konstanten für den Weg den der Roboter zurücklegen soll define ROBOT_SPEED 120 ' Geschwindigkeit die der Roboter fahren soll define moved byte[9] ' Varibel für den tasächlich zurück gelegte weg define k byte[10] ' Schleifen Zähler '---------- INIT--------------- gosub SUBSYS_PWR_ON beep 368,10,0:pause 50 '---- SYSTEM OPERATION MODE (NO INTERRUPT) ---- gosub NO_ACS_INT:beep 368,10,0:SYS ACS_LO '------------ ANTRIEB ------------------------- REV_L=on:REV_R=on:SYS PLM_SLOW '-------------------------------------------- moved = 0 gosub CLR_DISTANCE:gosub LEDSOFF:gosub move_fwd #MOVE_FORWARD pause 5:SYS COMNAV_STATUS gosub L_DISTANCE if (ACSL_F or ACSR_F)=on then goto WAYNOTFREE if LBYTE=(MAX_LENGTH/4) then gosub LED1ON if LBYTE=(2*MAX_LENGTH/4) then gosub LED2ON if LBYTE=(3*MAX_LENGTH/4) then gosub LED3ON if LBYTE=MAX_LENGTH then goto FORWARDFINISH goto MOVE_FORWARD '-------------------------------------------- ' Wenn der Roboter auf ein hindernis gestoßen ist und nicht eine Strecke entsprechend ' MAX_LENGTH zurücklegen kann #WAYNOTFREE moved = LBYTE ' Den Weg den der Roboter zurückgelegt hat merken SYS FWDR:SYS FWDL:SPEED_L=0:SPEED_R=0:pause 10 ' Roboter Stoppen lassen beep 368,10,0:pause 20 beep 368,10,0:pause 20 for k = 0 to 5 gosub LED1ON:gosub LED2ON:gosub LED3ON:gosub LED4ON:pause 5 gosub LEDSOFF:pause 5 next goto FORWARDFINISH '--------------------------------------------- #FORWARDFINISH moved = LBYTE ' Den Weg den der Roboter zurückgelegt hat merken gosub LED4ON SYS FWDR:SYS FWDL:SPEED_L=0:SPEED_R=0:pause 10 ' Roboter Stoppen lassen for k = 0 to 5 gosub LED1ON:pause 5:gosub LED1OFF gosub LED2ON:pause 5:gosub LED2OFF gosub LED3ON:pause 5:gosub LED3OFF gosub LED4ON:pause 5:gosub LED4OFF gosub LED3ON:pause 5:gosub LED3OFF gosub LED2ON:pause 5:gosub LED2OFF next if moved = 0 then goto stop else gosub CLR_DISTANCE:gosub LEDSOFF:gosub move_rev goto MOVE_BACK #MOVE_BACK pause 5:SYS COMNAV_STATUS gosub L_DISTANCE if LBYTE=(moved/4) then gosub LED1ON if LBYTE=(2*moved/4) then gosub LED2ON if LBYTE=(3*moved/4) then gosub LED3ON if LBYTE=moved then goto stop goto MOVE_BACK '--------------------------------------------- #stop gosub LED4ON SYS FWDR:SYS FWDL:SPEED_L=0:SPEED_R=0:end '--------------------------------------------- ' Roboter vorwärds fahren lassen #move_fwd SYS FWDR:SYS FWDL:SPEED_L=ROBOT_SPEED:SPEED_R=ROBOT_SPEED:return '--------------------------------------------- ' Roboter rückwärds fahren lassen #move_rev SYS REVR:SYS REVL:SPEED_L=ROBOT_SPEED:SPEED_R=ROBOT_SPEED:return '--------------------------------------------- 'IIIIIIIIIII LED DRIVER IIIIIIIIIIIIIIIII #LED1ON LED1_F=on:goto EXTPORT_WRITE #LED1OFF LED1_F=off :goto EXTPORT_WRITE #LED2ON LED2_F=on:goto EXTPORT_WRITE #LED2OFF LED2_F=off:goto EXTPORT_WRITE #LED3ON LED3_F=on:goto EXTPORT_WRITE #LED3OFF LED3_F=off:goto EXTPORT_WRITE #LED4ON LED4_F=on:goto EXTPORT_WRITE #LED4OFF LED4_F=off:goto EXTPORT_WRITE #LEDSOFF EXTPORT=EXTPORT and &H0F:goto EXTPORT_WRITE #EXTPORT_WRITE SYS SYSTEM:pulse STROBE:RETURN 'IIIIII SYSTEMROUTINEN COMM/NAV SYSTEM IIIII #GET_IRDATA SUBCMD=1:sys COMNAV:return #SEND_IRDATA SUBCMD=0:sys COMNAV:return #RC5 SUBCMD=4:sys COMNAV:LBYTE= HBYTE and &HFC HBYTE=00:SUBCMD=2:sys COMNAV:return #RC5_INT SUBCMD=4:sys COMNAV:LBYTE= (HBYTE and &HFE)or 2 HBYTE=00:SUBCMD=2:sys COMNAV:return #REC80 SUBCMD=4:sys COMNAV:LBYTE= (HBYTE or &H01)and&HFD HBYTE=00:SUBCMD=2:sys COMNAV:return #REC80_INT SUBCMD=4:sys COMNAV:LBYTE= (HBYTE or &H03) HBYTE=00:SUBCMD=2:sys COMNAV:return 'IIIIII SYSTEMROUTINEN SYSTEM IIIIIIIIIIII #NO_ACS_INT SUBCMD=4:sys COMNAV:LBYTE= HBYTE and &HFB HBYTE=00:SUBCMD=2:sys COMNAV:return #ACS_INT_200 SUBCMD=4:sys COMNAV:LBYTE= HBYTE or &H04 HBYTE=50:SUBCMD=2:sys COMNAV:return #SUBSYS_PWR_ON sdio=on:sclio=on:strobe=off:EXTPORT=(EXTPORT and &HFE)or 8 sys SYSTEM:return #SUBSYS_PWR_OFF EXTPORT=(EXTPORT and &HF7)or 1:sys SYSTEM deact sdio:deact sclio:return #CLR_DISTANCE SUBCMD=3:sys COMNAV:return #L_DISTANCE SUBCMD=6:sys COMNAV:return #R_DISTANCE SUBCMD=7:sys COMNAV:return '---------COM/NAV GERÄTEREIBER ------------- 'syscode "p5driv.s19"







Zitieren

Lesezeichen