Subversion Repositories FlightCtrl

Rev

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

Rev 2408 Rev 2416
Line 408... Line 408...
408
                                        PcZugriff = 255;
408
                                        PcZugriff = 255;
409
                                        break;
409
                                        break;
Line 410... Line 410...
410
 
410
 
411
                        case 'q':// "Get"-Anforderung für Settings
411
                        case 'q':// "Get"-Anforderung für Settings
412
                                        // Bei Get werden die vom PC einstellbaren Werte vom PC zurückgelesen
412
                                        // Bei Get werden die vom PC einstellbaren Werte vom PC zurückgelesen
-
 
413
                                   if(!MotorenEin)
413
                                        if(MotorenEin) break;
414
                                   {
414
                                        if((10 <= pRxData[0]) && (pRxData[0] < 20))
415
                                        if((10 <= pRxData[0]) && (pRxData[0] < 20))
415
                                        {
416
                                        {
416
                                                tempchar1 = pRxData[0] - 10;
417
                                                tempchar1 = pRxData[0] - 10;
417
                                                if(tempchar1< 1) tempchar1 = 1; // limit to 1
418
                                                if(tempchar1< 1) tempchar1 = 1; // limit to 1
Line 435... Line 436...
435
                                                if(tempchar1< 1) tempchar1 = 1; // limit to 1
436
                                                if(tempchar1< 1) tempchar1 = 1; // limit to 1
436
                                                else if(tempchar1 > 5) tempchar1 = 5; // limit to 5
437
                                                else if(tempchar1 > 5) tempchar1 = 5; // limit to 5
437
                                                // load requested parameter set
438
                                                // load requested parameter set
438
                                                ParamSet_ReadFromEEProm(tempchar1);
439
                                                ParamSet_ReadFromEEProm(tempchar1);
439
                                        }
440
                                        }
-
 
441
                                        LipoDetection(0);
-
 
442
                                   } else tempchar1 = GetActiveParamSet();     
440
                                        while(!UebertragungAbgeschlossen);
443
                                        while(!UebertragungAbgeschlossen);
441
                                        SendOutData('Q', FC_ADDRESS, 2, &tempchar1, sizeof(tempchar1), (unsigned char *) &EE_Parameter, sizeof(EE_Parameter) - 1);
444
                                        SendOutData('Q', FC_ADDRESS, 2, &tempchar1, sizeof(tempchar1), (unsigned char *) &EE_Parameter, sizeof(EE_Parameter) - 1);
442
                                        Debug("Lese Setting %d", tempchar1);
445
                                        Debug("Lese Setting %d", tempchar1);
443
                                        LipoDetection(0);
-
 
444
                                        break;
446
                                        break;
Line 445... Line 447...
445
 
447
 
446
                        case 's': // Parametersatz speichern
448
                        case 's': // Parametersatz speichern
447
                                        if((1 <= pRxData[0]) && (pRxData[0] <= 5) && (pRxData[1] == EEPARAM_REVISION) && MotorenEin == 0) // check for setting to be in range
449
                                        if((1 <= pRxData[0]) && (pRxData[0] <= 5) && (pRxData[1] == EEPARAM_REVISION) && MotorenEin == 0) // check for setting to be in range
Line 781... Line 783...
781
                  WinkelOut.Winkel[1] = ToNaviCtrl.IntegralRoll;//(int) (IntegralRoll / (EE_Parameter.GyroAccFaktor * 4));  // etwa in 0.1 Grad
783
                  WinkelOut.Winkel[1] = ToNaviCtrl.IntegralRoll;//(int) (IntegralRoll / (EE_Parameter.GyroAccFaktor * 4));  // etwa in 0.1 Grad
782
                  WinkelOut.UserParameter[0] = Parameter_UserParam1;
784
                  WinkelOut.UserParameter[0] = Parameter_UserParam1;
783
                  WinkelOut.UserParameter[1] = Parameter_UserParam2;
785
                  WinkelOut.UserParameter[1] = Parameter_UserParam2;
784
          SendOutData('k', MK3MAG_ADDRESS, 1, (unsigned char *) &WinkelOut,sizeof(WinkelOut));
786
          SendOutData('k', MK3MAG_ADDRESS, 1, (unsigned char *) &WinkelOut,sizeof(WinkelOut));
785
          if(WinkelOut.CalcState > 4)  WinkelOut.CalcState = 6; // wird dann in SPI auf Null gesetzt
787
          if(WinkelOut.CalcState > 4)  WinkelOut.CalcState = 6; // wird dann in SPI auf Null gesetzt
786
          if(!NaviDataOkay) Kompass_Timer = SetDelay(99);
788
          if(JustMK3MagConnected) Kompass_Timer = SetDelay(99);
787
                  else Kompass_Timer = SetDelay(999);
789
                  else Kompass_Timer = SetDelay(999);
788
         }
790
         }
789
#ifdef DEBUG                                                                                                                    // only include functions if DEBUG is defined
791
#ifdef DEBUG                                                                                                                    // only include functions if DEBUG is defined
790
     if(SendDebugOutput && UebertragungAbgeschlossen)
792
     if(SendDebugOutput && UebertragungAbgeschlossen)
791
     {
793
     {