Subversion Repositories svnkaklik

Rev

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

Rev Author Line No. Line
360 kakl 1 
//--- Diagnostika cidel a vymazani EEPROM ---
2 
void diag()
3 
{
4 
   int8 n;
5 
 
6 
   // Vymaz Black Box v EEPROM
7 
   for(n=0;n<255;n++) write_eeprom(n,0);
8 
   bb_l[0]=0;        // Zapis na pozici 0 vzdalenost 0
9 
   bb_h[0]=0;
10 
   SaveLog(0);       // Zapis do EEPROM pocet zaznamu 0, tedy jeden zaznam
11 
   for(n=0;n<=4;n++)
12 
   {
13 
      disp(0x55);       // Blikni pro potvrzeni
14 
      delay_ms(200);
15 
      disp(0xAA);
16 
      delay_ms(200);
17 
   };
18 
 
19 
   while(true)
20 
   {
21 
      if(!IRRX)
22 
      {
23 
         int8 ble;
24 
 
25 
         i2c_start();     // Cteni kompasu
26 
         i2c_write(COMPAS_ADR);
27 
         i2c_write(0x1);
28 
         i2c_stop();
29 
         i2c_start();
30 
         i2c_write(COMPAS_ADR+1);
31 
         ble=i2c_read(0);
32 
         i2c_stop();
33 
         disp(ble);
34 
         delay_ms(200);
35 
      }
36 
      else
37 
      {
38 
         i2c_start();      // Diagnostika sonaru
39 
         i2c_write(SONAR_ADR);
40 
         i2c_write(0x02);  // dosah
41 
         i2c_write(0x03);  // n*43mm
42 
         i2c_stop();
43 
         i2c_start();
44 
         i2c_write(SONAR_ADR);
45 
         i2c_write(0x01);  // zesileni
46 
         i2c_write(0x01);  // male, pro eliminaci echa z minuleho mereni
47 
         i2c_stop();
48 
 
49 
         i2c_start();     // Sonar Ping
50 
         i2c_write(0xE0);
51 
         i2c_write(0x0);
52 
         i2c_write(0x51);  // 50 mereni v palcich, 51 mereni v cm, 52 v us
53 
         i2c_stop();
54 
         delay_ms(100);
55 
         i2c_start();     // Odraz ze sonaru
56 
         i2c_write(0xE0);
57 
         i2c_write(0x3);
58 
         i2c_stop();
59 
         i2c_start();
60 
         i2c_write(0xE1);
61 
         n=i2c_read(0);
62 
         i2c_stop();
63 
         disp(n);  // Zobrazeni hodnoty ze sonaru a zaroven diagnostika predniho IR cidla
64 
         delay_ms(200);
65 
      }
66 
   }
67 
}