Kód: Vybrat vše
symbol LMf =C.5 ;levy motor plus
symbol LMb =C.4 ;levy motor minus
symbol PMf =C.3 ;pravy motor plus
symbol PMb =B.4 ;pravy motor minus
symbol PC =B.0 ;prave cidlo
symbol PSC =B.2 ;prave stredni cidlo
symbol SC =B.3 ;stredni cidlo
symbol LSC =B.5 ;leve stredni cidlo
symbol LC =B.6 ;leve cidlo
symbol IR =B.1 ;IR ledka
main:
pwmout IR,25,52 ;bliká IR ledkou na 38Khz
pause 3
IF pinC.6=1 then ;pokud je na TSOP4838 log.1
high LMf
low LMb,PMf,PMb
pause 200
high LMf,PMf
low LMb,PMb
pause 300
high PMf
low LMf,LMb,PMb
pwmout IR,0,0
pause 20
else
readadc PC ,b1
readadc PSC ,b2
readadc SC ,b3
readadc LSC ,b4
readadc LC ,b5
IF b1>140 then
pwmout PMf,0,0:pwmout LMf,0,0
pwmout pwmdiv4,LMf,30,100
endif
IF b2>12 then
pwmout LMf,00,00:pwmout PMf,00,00
pwmout pwmdiv4,LMf,30,100
pwmout pwmdiv4,PMf,30,75
endif
IF b3>12 then
pwmout PMf,0,0:pwmout LMf,0,0
pwmout pwmdiv4,LMf,30,110
pwmout pwmdiv4,PMf,30,105
endif
IF b4>11 then
pwmout LMf,00,00:pwmout PMf,00,00
pwmout pwmdiv4,LMf,30,80
pwmout pwmdiv4,PMf,30,95
endif
IF b5>150 then
pwmout PMf,0,0:pwmout LMf,0,0
pwmout pwmdiv4,PMf,30,95
endif
pwmout IR,0,0
pause 20
endif
goto main