This repository has been archived by the owner on Oct 25, 2022. It is now read-only.
-
Notifications
You must be signed in to change notification settings - Fork 0
/
ir_clbr.sb
82 lines (60 loc) · 1.38 KB
/
ir_clbr.sb
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
IRSEEKER = 1
file = EV3File.OpenWrite("/home/root/lms2012/prjs/SD_Card/lol/.calibration/ir.txt")
Sub irseeker_update
ir_raw = Sensor.ReadI2CRegisters(IRSEEKER, 8, 73, 6)
int = (ir_raw[1] + ir_raw[2] + ir_raw[3] + ir_raw[4] + ir_raw[5]) / (2 - Math.Remainder(ir_raw[0], 2))
dir = ir_raw[0] - 5
EndSub
LCD.PrintUpd()
LCD.CenterText(1, 20, 1, "Press E")
While Buttons.Current <> "E"
EndWhile
Speaker.Tone(40, 1000, 100)
Program.Delay(100)
For i = 1 to 9
data[i] = 0
EndFor
While Buttons.Current <> "E"
irseeker_update()
data[dir] = Math.Max(data[dit], int)
LCD.PrintUpd()
For i = 1 to 9
LCD.Print(i, data[i])
EndFor
EndWhile
For i = 1 to 9
EV3File.WriteLine(file, data[i])
EndFor
Speaker.Tone(40, 1000, 100)
Program.Delay(100)
For i = 1 to 9
data[i] = 0
EndFor
While Buttons.Current <> "E"
irseeker_update()
data[dir] = Math.Max(data[dit], int)
LCD.PrintUpd()
For i = 1 to 9
LCD.Print(i, data[i])
EndFor
EndWhile
For i = 1 to 9
EV3File.WriteLine(file, data[i])
EndFor
Speaker.Tone(40, 1000, 100)
Program.Delay(100)
For i = 1 to 9
data[i] = 0
EndFor
While Buttons.Current <> "E"
irseeker_update()
data[dir] = Math.Max(data[dit], int)
LCD.PrintUpd()
For i = 1 to 9
LCD.Print(i, data[i])
EndFor
EndWhile
For i = 1 to 9
EV3File.WriteLine(file, data[i])
EndFor
EV3File.Close(file)