Subversion Repositories FlightCtrl

Rev

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

Rev 529 Rev 539
Line 153... Line 153...
153
//############################################################################
153
//############################################################################
154
//  Nullwerte ermitteln
154
//  Nullwerte ermitteln
155
void SetNeutral(void)
155
void SetNeutral(void)
156
//############################################################################
156
//############################################################################
157
{
157
{
-
 
158
        // Salvo 9.12.2007
-
 
159
        RX_SWTCH_ON; //GPS Daten auf RX eingang schalten 
-
 
160
        // Salvo End
158
        NeutralAccX = 0;
161
        NeutralAccX = 0;
159
        NeutralAccY = 0;
162
        NeutralAccY = 0;
160
        NeutralAccZ = 0;
163
        NeutralAccZ = 0;
161
    AdNeutralNick = 0; 
164
    AdNeutralNick = 0; 
162
        AdNeutralRoll = 0;     
165
        AdNeutralRoll = 0;     
Line 623... Line 626...
623
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++                
626
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++                
624
// Einschalten
627
// Einschalten
625
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++                
628
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++                
626
                    if(++delay_einschalten > 200)
629
                    if(++delay_einschalten > 200)
627
                        {
630
                        {
-
 
631
                                                // Salvo 9.12.2007
-
 
632
                                                RX_SWTCH_ON; //GPS Daten auf RX eingang schalten 
-
 
633
                                                // Salvo End
628
                        delay_einschalten = 200;
634
                        delay_einschalten = 200;
629
                        modell_fliegt = 1;
635
                        modell_fliegt = 1;
630
                        MotorenEin = 1;
636
                        MotorenEin = 1;
631
                        sollGier = 0;
637
                        sollGier = 0;
632
                        Mess_Integral_Gier = 0;
638
                        Mess_Integral_Gier = 0;
Line 646... Line 652...
646
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++                
652
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++                
647
                if(PPM_in[EE_Parameter.Kanalbelegung[K_GIER]] > 75)
653
                if(PPM_in[EE_Parameter.Kanalbelegung[K_GIER]] > 75)
648
                    {
654
                    {
649
                    if(++delay_ausschalten > 200)  // nicht sofort
655
                    if(++delay_ausschalten > 200)  // nicht sofort
650
                        {
656
                        {
-
 
657
                                                // Salvo 9.12.2007
-
 
658
                                                RX_SWTCH_OFF; //Bluetooth Daten auf RX eingang schalten 
-
 
659
                                                // Salvo End
651
                        MotorenEin = 0;
660
                        MotorenEin = 0;
652
                        delay_ausschalten = 200;
661
                        delay_ausschalten = 200;
653
                        modell_fliegt = 0;
662
                        modell_fliegt = 0;
654
                        }
663
                        }
655
                    }
664
                    }
Line 1111... Line 1120...
1111
        DebugOut.Analog[22] =  StickRoll;
1120
        DebugOut.Analog[22] =  StickRoll;
1112
        DebugOut.Analog[23] =  StickGier;
1121
        DebugOut.Analog[23] =  StickGier;
Line 1113... Line 1122...
1113
 
1122
 
1114
 
1123
 
1115
// GPS Debugging
1124
// GPS Debugging
1116
        DebugOut.Analog[26] =  gps_rel_act_position.utm_east;
1125
        DebugOut.Analog[26] =  gps_rel_act_position.utm_east/10; //in m ausgeben
1117
        DebugOut.Analog[27] =  gps_rel_act_position.utm_north;
1126
        DebugOut.Analog[27] =  gps_rel_act_position.utm_north/10;
Line 1118... Line 1127...
1118
        DebugOut.Analog[28] =  gps_rel_act_position.utm_alt;
1127
        DebugOut.Analog[28] =  gps_rel_act_position.utm_alt/10;
1119
        DebugOut.Analog[29] =  gps_sub_state+(20*gps_cmd);
1128
        DebugOut.Analog[29] =  gps_sub_state+(20*gps_cmd);
1120
 
1129