Subversion Repositories FlightCtrl

Rev

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

Rev 76 Rev 84
Line 50... Line 50...
50 
   }
 50 
   }
51 
  else
 51 
  else
52 
   {
 52 
   {
53 
    if((cntKompass) && (cntKompass < 4000))
 53 
    if((cntKompass) && (cntKompass < 4000))
54 
    {
 54 
    {
55 
     KompassValue = cntKompass;
 55 
     KompassValue = cntKompass;
- 
 
 56 
    // Salvo Korrektur Ausrichtung kompass  ****************************
- 
 
 57 
                KompassValue -= KOMPASS_OFFSET ;
- 
 
 58 
                 if (KompassValue < 0)
56 
    }
 59 
                 {
57 
//     if(cntKompass < 10) cntKompass = 10;
 60 
                        KompassValue = KompassValue +360;
- 
 
 61 
                 }
58 
//     KompassValue = (unsigned long)((unsigned long)(cntKompass-10)*720L + 1L) / 703L;
 62 
                 if (KompassValue >= 360)  
- 
 
 63 
                 {
59 
     KompassRichtung = ((540 + KompassValue - KompassStartwert) % 360) - 180;
 64 
                        KompassValue = KompassValue -360;
- 
 
 65 
                 }        
- 
 
 66 
// Salvo End ********************                              
- 
 
 67 
        }
- 
 
 68 
 
60 
    cntKompass = 0;
 69 
         cntKompass = 0;
- 
 
 70 
         KompassRichtung = ((540 + KompassValue - KompassStartwert) % 360) - 180;
61 
   }
 71 
   }
62 
 }
 72 
 }
63 
}
 73 
}