Rev 2408 | Rev 2418 | Go to most recent revision | Show entire file | Regard 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 | { |