Subversion Repositories FlightCtrl

Rev

Rev 232 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 232 Rev 235
Line 41... Line 41...
41 
     else  
 41 
     else  
42 
        PORTD &= ~(1<<PD2);
 42 
        PORTD &= ~(1<<PD2);
Line 43... Line 43...
43 
 
 43 
 
Line 44... Line -...
44 
  if(EE_Parameter.GlobalConfig & CFG_KOMPASS_AKTIV) MM3_timer0();
 - 
 
45 
 
 - 
 
46 
  /*
 - 
 
47 
  if(PINC & 0x10)
 - 
 
48 
   {
 - 
 
49 
    cntKompass++;
 - 
 
50 
   }
 - 
 
51 
  else
 - 
 
52 
   {
 - 
 
53 
    if((cntKompass) && (cntKompass < 4000))
 - 
 
54 
    {
 - 
 
55 
     KompassValue = cntKompass;
 - 
 
56 
    }
 - 
 
57 
//     if(cntKompass < 10) cntKompass = 10;
 44 
  if(EE_Parameter.GlobalConfig & CFG_KOMPASS_AKTIV) MM3_timer0();
58 
//     KompassValue = (unsigned long)((unsigned long)(cntKompass-10)*720L + 1L) / 703L;
 - 
 
59 
     KompassRichtung = ((540 + KompassValue - KompassStartwert) % 360) - 180;
 - 
 
Line 60... Line -...
60 
    cntKompass = 0;
 - 
 
Line 61... Line 45...
61 
   }
 45 
 
Line 62... Line 46...
62 
 
 46 
  //KompassRichtung = ((540 + KompassValue - KompassStartwert) % 360) - 180;