Programme :
(les lettres A, B, C, D, E et F correspondent aux différentes
parties du chronogramme de déplacement)
10 DIM J AS BYTE
' interrupteur 20 DIM CG AS BYTE '
Capteur gauche 30 DIM CD AS BYTE ' Capteur
droit 40 CONST MG=3
' Moteur gauche 50 CONST
MD=4 ' Moteur droit
60 CONST LED=5 '
LED 70 CONST
BIP=6 '
BUZZER 80 CONST VIBRE=7 ' VIBREUR
CYCLE DEPLACEMENT :
100 ON INT(16)=0 GOSUB 1000 110
J=IN(11) 120 CG=IN(16) 130 IF J=0 THEN
_____________________________ 140 OUT MG,1 150 OUT
MD,1 160 DELAY 1000 170 OUT MG,1 180 OUT
MD,1 190 DELAY
1000 A
(aller
tout droit) 200 OUT MG,1 210 OUT
MD,1 220 DELAY 1000 230 OUT MG,1 240 OUT
MD,1 250 DELAY 1000
_____________________________
260 OUT MG,1 270 OUT MD,0 280 DELAY
200 290 OUT MG,1 300 OUT MD,0 310 DELAY
200
B (tourner
à
droite) 320 OUT MG,1 330 OUT MD,0 340 DELAY
200 350 OUT MG,1 360 OUT MD,0 370 DELAY 200
_____________________________
380 OUT MG,1 390 OUT MD,1 400 DELAY
1000 410 OUT MG,1 420 OUT MD,1 430 DELAY
1000 C
(aller tout
droit) 440 OUT MG,1 450 OUT MD,1 460 DELAY
1000 470 OUT MG,1 480 OUT MD,1 490 DELAY 1000
_____________________________
500 OUT MG,0 510 OUT MD,1 520 DELAY
200 530 OUT MG,0 540 OUT MD,1 550 DELAY
200
D (tourner
à
gauche) 560 OUT MG,0 570 OUT MD,1 580 DELAY
200 590 OUT MG,0 600 OUT MD,1 610 DELAY 200
_____________________________
620 OUT MG,1 630 OUT MD,1 640 DELAY
1000 650 OUT MG,1 660 OUT MD,1 670 DELAY
1000 E
(aller tout
droit) 680 OUT MG,1 690 OUT MD,1 700 DELAY
1000 710 OUT MG,1 720 OUT MD,1 730 DELAY
1000
_____________________________
740 OUT MG,0 750 OUT
MD,0 F
(Arrêt) 760 END
IF 770 GOTO 100
CYCLE DETECTION :
1000 OUT MG,0 1010 OUT MD,0 1020 OUT
6,1 1030 OUT 5,1 1040 OUT 7,1 1050 DELAY 5000 1060 OUT
6,0 1070 OUT 5,0 1080 OUT
7,0 1090 RETURN
| |