/roboti/Robiada/2007/SW/robot/robot.bas |
---|
33,22 → 33,12 |
txreg = c |
End Sub |
Sub delay(cas As Byte) |
Dim i As Byte |
Dim x As Byte |
Do while i <= cas |
Do While x <= 100 |
Call receive() |
x=x+1 |
loop |
i=i+1 |
loop |
End Sub |
Sub main() |
Dim motors As Byte |
Dim sensors As Byte |
Dim buttons As Byte |
Dim leds As Byte |
Dim count As word |
Dim i As Long |
'NASTAVENI IO |
71,20 → 61,30 |
rcsta = rcsta | (1 << SPEN) |
motors = 0x00 |
do while (portb.0 = 1) |
loop |
leds = 0xF0 |
count = 400000 |
lata = 0x0E |
Call delay(200) |
lata = 0x0D |
Call delay(200) |
lata = 0x0B |
Call delay(200) |
lata = 0x07 |
Call delay(200) |
do while (count > 0) |
count = count -1 |
if count < 300000 then |
leds = leds | 1 |
end if |
if count < 200000 then |
leds = leds | 2 |
end if |
if count < 100000 then |
leds = leds | 4 |
end if |
lata = leds |
loop |
leds = 0xFF |
lata = 0xFF |
motors = 0x77 |
Call delay(100) |
Do while 1 |