Subversion Repositories svnkaklik

Rev

Rev 321 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log

Rev 321 Rev 322
Line 31... Line 31...
31
Sub send(c As Byte)
31
Sub send(c As Byte)
32
	Do while (pir1 & (1 << TXIF)) = 0 Loop
32
	Do while (pir1 & (1 << TXIF)) = 0 Loop
33
	txreg = c
33
	txreg = c
34
End Sub
34
End Sub
35
 
35
 
36
Sub delay(cas As Byte)
-
 
37
Dim i As Byte
-
 
38
Dim x As Byte
-
 
39
    Do while i <= cas
-
 
40
     Do While x <= 100
-
 
41
      Call receive()
-
 
42
      x=x+1
-
 
43
     loop
-
 
44
    i=i+1
-
 
45
	loop	
-
 
46
End Sub
-
 
47
 
-
 
48
Sub main()
36
Sub main()
49
	Dim motors As Byte
37
	Dim motors As Byte
50
	Dim sensors As Byte
38
	Dim sensors As Byte
51
	Dim buttons As Byte
39
	Dim buttons As Byte
-
 
40
	Dim leds As Byte
-
 
41
	Dim count As word
52
	Dim i As Long
42
	Dim i As Long
53
 
43
 
54
	'NASTAVENI IO
44
	'NASTAVENI IO
55
	lata=0xFF
45
	lata=0xFF
56
	latb=0
46
	latb=0
Line 69... Line 59...
69
	txsta = txsta | (1 << TXEN)
59
	txsta = txsta | (1 << TXEN)
70
	rcsta = rcsta | (1 << CREN)
60
	rcsta = rcsta | (1 << CREN)
71
	rcsta = rcsta | (1 << SPEN)
61
	rcsta = rcsta | (1 << SPEN)
72
			 	
62
			 	
73
	motors = 0x00
63
	motors = 0x00
74
	
64
		
75
	lata = 0x0E 
-
 
76
    Call delay(200)
65
    do while (portb.0 = 1)
77
	lata = 0x0D
-
 
78
    Call delay(200)
-
 
79
	lata = 0x0B
-
 
80
    Call delay(200)
-
 
81
	lata = 0x07
66
	loop
82
    Call delay(200)
-
 
83
 
-
 
84
	motors = 0x77
-
 
85
 
67
 
-
 
68
	leds = 0xF0
-
 
69
	count = 400000
-
 
70
	
86
    Call delay(100)
71
	do while (count > 0)
-
 
72
		count = count -1
-
 
73
		
-
 
74
		if count < 300000 then
-
 
75
			leds = leds | 1
-
 
76
		end if
-
 
77
		if count < 200000 then
-
 
78
			leds = leds | 2
-
 
79
		end if
-
 
80
		if count < 100000 then
-
 
81
			leds = leds | 4
-
 
82
		end if
-
 
83
		lata = leds
-
 
84
	loop
-
 
85
	leds = 0xFF
-
 
86
	lata = 0xFF
87
 
87
 
88
		
88
		
89
Do while 1
89
Do while 1
90
 
90
 
91
  sensors =0xFF 
91
  sensors =0xFF