Subversion Repositories FlightCtrl

Rev

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

Rev 77 Rev 84
Line 655... Line 655...
655
       w = (w * Parameter_KompassWirkung) / 64;           // auf die Wirkung normieren
655
       w = (w * Parameter_KompassWirkung) / 64;           // auf die Wirkung normieren
656
       w = Parameter_KompassWirkung - w;                  // Wirkung ggf drosseln
656
       w = Parameter_KompassWirkung - w;                  // Wirkung ggf drosseln
657
       if(w > 0)
657
       if(w > 0)
658
        {
658
        {
659
          ANALOG_OFF; // ADC ausschalten, damit die Werte sich nicht während der Berechnung ändern
659
          ANALOG_OFF; // ADC ausschalten, damit die Werte sich nicht während der Berechnung ändern
-
 
660
// Salvo Winkelbegrenzung 29.8.2007 ******************
-
 
661
                  if ( (abs (KompassRichtung)) < 135 )
-
 
662
                  {
660
          if(!SignalSchlecht) Mess_Integral_Gier += (KompassRichtung * w) / 32;  // nach Kompass ausrichten
663
                if(!SignalSchlecht) Mess_Integral_Gier += (KompassRichtung * w) / 32;  // nach Kompass ausrichten
-
 
664
                  }
-
 
665
 // Salvo End
661
          ANALOG_ON;  // ADC einschalten
666
         ANALOG_ON;  // ADC einschalten
662
          if(SignalSchlecht) SignalSchlecht--;
667
          if(SignalSchlecht) SignalSchlecht--;
663
        }  
668
        }  
664
        else SignalSchlecht = 500; // so lange das Signal taub stellen --> ca. 1 sek
669
        else SignalSchlecht = 500; // so lange das Signal taub stellen --> ca. 1 sek
665
     }
670
     }
666
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++                
671
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++