Subversion Repositories svnkaklik

Rev

Go to most recent revision | Details | Last modification | View Log

Rev Author Line No. Line
1 kaklik 1 
#define THRESHOLD  44     // rozhodovaci uroven mezi cernou a bilou
2 
#define RED_WHITE  60     // maximum bile na cervenem senzoru
3 
#define MLEFT     OUT_A
4 
#define MRIGHT    OUT_C
5 
#define BLUE      SENSOR_1
6 
#define RED       SENSOR_2
7 
#define BBUMPER   SENSOR_3
8 
#define START_ALL start blue_bumper; start cara_cervena; start cara_modra;
9 
 
10 
int semafor;
11 
 
12 
task main()
13 
{
14 
  PlaySound (SOUND_DOUBLE_BEEP);
15 
  Wait(500); // 5s podle pravidel
16 
  SetSensor(BLUE,SENSOR_LIGHT);   // senzor na caru modry
17 
  SetSensor(RED,SENSOR_LIGHT);   // senzor na caru cerveny
18 
  SetSensor(BBUMPER, SENSOR_TOUCH);  // naraznik modry
19 
  SetSensorMode (BBUMPER, SENSOR_MODE_BOOL); // koncak bude ...
20 
  SetPower (MLEFT,OUT_FULL);
21 
  SetPower (MRIGHT,OUT_FULL);
22 
  SetDirection(MLEFT, OUT_FWD);
23 
  SetDirection(MRIGHT, OUT_FWD);
24 
 
25 
//  k_care();
26 
  OnFwd (MLEFT);                  // dojezd k care
27 
  OnFwd (MRIGHT);                  // dojezd k care
28 
  Wait(50);
29 
  GoRed();
30 
 
31 
  start red_bumper;
32 
  start blue_bumper;
33 
  start cara_cervena;
34 
  start cara_modra;
35 
  semafor = false;
36 
 
37 
  ClearTimer (0);
38 
  start stochastika;
39 
}
40 
 
41 
task stochastika()
42 
{
43 
   while (true)
44 
   {
45 
     Wait(500);
46 
     if (semafor) start blue_bumper;
47 
 
48 
     PlaySound (SOUND_CLICK);
49 
 
50 
     OnFwd (MLEFT);                  // dojezd k care
51 
     OnFwd (MRIGHT);                 // dojezd k care
52 
     while (BLUE > THRESHOLD);
53 
     GoRed();
54 
     OnRev (MLEFT);
55 
     OnRev (MRIGHT);
56 
     Wait(100);              // popojed kus
57 
     Zatoc();
58 
 
59 
     ClearTimer (0);
60 
   }
61 
}
62 
 
63 
void GoBlue()
64 
{
65 
  OnFwd (MLEFT);
66 
  OnFwd (MRIGHT);
67 
  Wait(100);              // popojed kus
68 
  Off(MLEFT);
69 
  Off(MRIGHT);
70 
}
71 
 
72 
void GoRed()
73 
{
74 
  OnRev (MLEFT);
75 
  OnRev (MRIGHT);
76 
  Wait(100);              // popojed kus
77 
  Off(MLEFT);
78 
  Off(MRIGHT);
79 
}
80 
 
81 
void Zatoc()
82 
{
83 
  switch (Random(2))
84 
  {
85 
    case 0:
86 
     OnRev (MLEFT);
87 
     OnFwd (MRIGHT);
88 
     break;
89 
    case 1:
90 
     OnFwd (MLEFT);
91 
     OnRev (MRIGHT);
92 
     break;
93 
    case 2:
94 
     OnRev (MLEFT);
95 
     OnRev (MRIGHT);
96 
  }
97 
  Wait(100);              // popojed kus
98 
  Off(MLEFT);
99 
  Off(MRIGHT);
100 
}
101 
 
102 
void k_care()  // najed do vyckavaci pozice
103 
{
104 
  OnFwd (MLEFT);                  // dojezd k care
105 
  OnFwd (MRIGHT);                  // dojezd k care
106 
  while (BLUE > THRESHOLD);
107 
  GoRed();
108 
  OnRev (MLEFT);
109 
  OnRev (MRIGHT);
110 
  Wait(100);              // popojed kus
111 
  Off(MLEFT);
112 
  Off(MRIGHT);
113 
}
114 
 
115 
task red_bumper()
116 
{
117 
  while(true)
118 
  {
119 
    while (100 != RED); // utoc, kdyz neco narazi do narazniku
120 
    PlaySound (SOUND_FAST_UP);
121 
    stop stochastika;
122 
    GoRed();
123 
//!!!    Zatoc();
124 
    start stochastika;
125 
    if (semafor) start blue_bumper;
126 
  }
127 
}
128 
 
129 
task blue_bumper()
130 
{
131 
    semafor = false;
132 
    while (0 == BBUMPER); // utoc, kdyz neco narazi do narazniku
133 
    PlaySound (SOUND_FAST_UP);
134 
    OnFwd (MLEFT);
135 
    OnFwd (MRIGHT);
136 
    semafor = true;
137 
}
138 
 
139 
task cara_cervena() // hlidani natlaceni na caru
140 
{
141 
  while(true)
142 
  {
143 
    while (RED < THRESHOLD || RED > RED_WHITE); // utoc, kdyz nas neco dotlaci k care
144 
    Wait(2);        // kontrola za 20ms, aby se to nespletlo s naraznikem
145 
    if (RED > THRESHOLD && RED < RED_WHITE)
146 
    {
147 
      PlaySound (SOUND_DOUBLE_BEEP);
148 
      GoBlue();
149 
    }
150 
  }
151 
}
152 
 
153 
task cara_modra()    // hlidani cary
154 
{
155 
  while(true)
156 
  {
157 
     while (BLUE > THRESHOLD);    // cekej na caru
158 
     stop cara_cervena;
159 
     PlaySound (SOUND_DOUBLE_BEEP);
160 
     GoRed();
161 
     if (semafor) start blue_bumper;
162 
     start cara_cervena;
163 
  }
164 
}
165