Subversion Repositories NaviCtrl

Rev

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

Rev 618 Rev 623
Line 434... Line 434...
434 
  Out1TriggerUpdateBlocked = 3; // makes sure that the right trigger-pos is sent in command 18
 434 
  Out1TriggerUpdateBlocked = 3; // makes sure that the right trigger-pos is sent in command 18
435 
  NaviData_Out1Trigger.Longitude = NaviData.CurrentPosition.Longitude;
 435 
  NaviData_Out1Trigger.Longitude = NaviData.CurrentPosition.Longitude;
436 
  NaviData_Out1Trigger.Latitude = NaviData.CurrentPosition.Latitude;
 436 
  NaviData_Out1Trigger.Latitude = NaviData.CurrentPosition.Latitude;
437 
                                 }
 437 
                                 }
438 
                                FC_WP_EventChannel_Processed = 1;
 438 
                                FC_WP_EventChannel_Processed = 1;
- 
 
 439 
//DebugOut.Analog[] = FC_WP_EventChannel;
439 
  // ++++++++++++++++++++++++++++++++++
 440 
  // ++++++++++++++++++++++++++++++++++
440 
  // Waypoint event +++++++++++++++++++
 441 
  // Waypoint event +++++++++++++++++++
441 
  // ++++++++++++++++++++++++++++++++++
 442 
  // ++++++++++++++++++++++++++++++++++
442 
                                if(NCRARAM_STATE_VALID == NCParams_GetValue(NCPARAMS_WP_EVENT_ONCE, &tmp))
 443 
                                if(NCRARAM_STATE_VALID == NCParams_GetValue(NCPARAMS_WP_EVENT_ONCE, &tmp))
443 
                                {
 444 
                                {
Line 671... Line 672...
671 
                                if(((LastTransmittedFCStatusFlags2 & FC_STATUS2_OUT1_ACTIVE)) && !(FC.StatusFlags2 & FC_STATUS2_OUT1_ACTIVE)) NaviData.FCStatusFlags2 &= ~FC_STATUS2_OUT1_ACTIVE;
 672 
                                if(((LastTransmittedFCStatusFlags2 & FC_STATUS2_OUT1_ACTIVE)) && !(FC.StatusFlags2 & FC_STATUS2_OUT1_ACTIVE)) NaviData.FCStatusFlags2 &= ~FC_STATUS2_OUT1_ACTIVE;
Line 672... Line 673...
672 
 
 673 
 
673 
                                if((!(LastTransmittedFCStatusFlags2 & FC_STATUS2_OUT2_ACTIVE)) && (FC.StatusFlags2 & FC_STATUS2_OUT2_ACTIVE)) NaviData.FCStatusFlags2 |= FC_STATUS2_OUT2_ACTIVE;
 674 
                                if((!(LastTransmittedFCStatusFlags2 & FC_STATUS2_OUT2_ACTIVE)) && (FC.StatusFlags2 & FC_STATUS2_OUT2_ACTIVE)) NaviData.FCStatusFlags2 |= FC_STATUS2_OUT2_ACTIVE;
674 
                                else
 675 
                                else
675 
                                if(((LastTransmittedFCStatusFlags2 & FC_STATUS2_OUT2_ACTIVE)) && !(FC.StatusFlags2 & FC_STATUS2_OUT2_ACTIVE)) NaviData.FCStatusFlags2 &= ~FC_STATUS2_OUT2_ACTIVE;
 - 
 
- 
 
 676 
                                if(((LastTransmittedFCStatusFlags2 & FC_STATUS2_OUT2_ACTIVE)) && !(FC.StatusFlags2 & FC_STATUS2_OUT2_ACTIVE)) NaviData.FCStatusFlags2 &= ~FC_STATUS2_OUT2_ACTIVE;
676 
 
 677 
//DebugOut.Analog[] = (NaviData.FCStatusFlags2 & FC_STATUS2_OUT1_ACTIVE);
677 
                                Logging_FCStatusFlags1 |= FC.StatusFlags;
 678 
                                Logging_FCStatusFlags1 |= FC.StatusFlags;
678 
                                Logging_FCStatusFlags2 |= FC.StatusFlags2;
 679 
                                Logging_FCStatusFlags2 |= FC.StatusFlags2;
679 
                                FC.BAT_Voltage = FromFlightCtrl.Param.Int[5]; // 10 & 11
 680 
                                FC.BAT_Voltage = FromFlightCtrl.Param.Int[5]; // 10 & 11
680 
                                DebugOut.Analog[7] = FC.BAT_Voltage;
 681 
                                DebugOut.Analog[7] = FC.BAT_Voltage;
Line 733... Line 734...
733 
                                CHK_POTI_MM(Parameter.NaviAccCompensation,FromFlightCtrl.Param.Byte[10],0,255);
 734 
                                CHK_POTI_MM(Parameter.NaviAccCompensation,FromFlightCtrl.Param.Byte[10],0,255);
734 
                                CHK_POTI_MM(Parameter.NaviAngleLimitation,FromFlightCtrl.Param.Byte[11],0,255);
 735 
                                CHK_POTI_MM(Parameter.NaviAngleLimitation,FromFlightCtrl.Param.Byte[11],0,255);
735 
                                break;
 736 
                                break;
736 
                        case SPI_FCCMD_PARAMETER2:
 737 
                        case SPI_FCCMD_PARAMETER2:
737 
                                CHK_POTI_MM(FC.AutoPhotoDistance,FromFlightCtrl.Param.Byte[0],0,255);
 738 
                                CHK_POTI_MM(FC.AutoPhotoDistance,FromFlightCtrl.Param.Byte[0],0,255);
- 
 
 739 
                                if(FromFlightCtrl.Param.Byte[1])
- 
 
 740 
                                 {
738 
                                if(FromFlightCtrl.Param.Byte[1]) FC.FromFC_SpeakHoTT = FromFlightCtrl.Param.Byte[1];     // will be cleared in the SD-Logging
 741 
                                  FC.FromFC_SpeakHoTT = FromFlightCtrl.Param.Byte[1];                   // will be cleared in the SD-Logging
- 
 
 742 
                                  NaviData_Flags.SpeakHoTT = FromFlightCtrl.Param.Byte[1];              // will be cleared after the Uart-Trasmitting
- 
 
 743 
                                 }
739 
                                FC.BAT_UsedCapacity = FromFlightCtrl.Param.Int[1]; // 2 & 3
 744 
                                FC.BAT_UsedCapacity = FromFlightCtrl.Param.Int[1]; // 2 & 3
740 
                                Parameter.FromFC_LowVoltageHomeActive = FromFlightCtrl.Param.Byte[4];
 745 
                                Parameter.FromFC_LowVoltageHomeActive = FromFlightCtrl.Param.Byte[4];
741 
                                if(FromFlightCtrl.Param.Byte[5]) FromFC_LoadWP_List = FromFlightCtrl.Param.Byte[5];
 746 
                                if(FromFlightCtrl.Param.Byte[5]) FromFC_LoadWP_List = FromFlightCtrl.Param.Byte[5];
742 
                                if(FromFlightCtrl.Param.Byte[6]) FromFC_Load_SinglePoint = FromFlightCtrl.Param.Byte[6];
 747 
                                if(FromFlightCtrl.Param.Byte[6]) FromFC_Load_SinglePoint = FromFlightCtrl.Param.Byte[6];
743 
                                if(FromFlightCtrl.Param.Byte[7]) FromFC_Save_SinglePoint = FromFlightCtrl.Param.Byte[7];
 748 
                                if(FromFlightCtrl.Param.Byte[7]) FromFC_Save_SinglePoint = FromFlightCtrl.Param.Byte[7];
Line 784... Line 789...
784 
                                else DebugOut.StatusRed &= ~AMPEL_FC;
 789 
                                else DebugOut.StatusRed &= ~AMPEL_FC;
785 
                                FC_I2C_ErrorConter = FromFlightCtrl.Param.Byte[8];
 790 
                                FC_I2C_ErrorConter = FromFlightCtrl.Param.Byte[8];
786 
                                FC.RC_Quality   = FromFlightCtrl.Param.Byte[9];
 791 
                                FC.RC_Quality   = FromFlightCtrl.Param.Byte[9];
787 
                                if(FC.RC_Quality > 160) NaviData.RC_Quality = 200; else NaviData.RC_Quality = FC.RC_Quality;
 792 
                                if(FC.RC_Quality > 160) NaviData.RC_Quality = 200; else NaviData.RC_Quality = FC.RC_Quality;
788 
                                NC_Wait_for_LED = FromFlightCtrl.Param.Byte[10];
 793 
                                NC_Wait_for_LED = FromFlightCtrl.Param.Byte[10];
- 
 
 794 
//DebugOut.Analog[] = NC_Wait_for_LED;
789 
                                NaviData.Gas    = (FC.BAT_Voltage * (u32) FromFlightCtrl.Param.Byte[11]) / (u32) Parameter.LowVoltageWarning;
 795 
                                NaviData.Gas    = (FC.BAT_Voltage * (u32) FromFlightCtrl.Param.Byte[11]) / (u32) Parameter.LowVoltageWarning;
790 
                                if(LoggingGasCnt == 0) LoggingGasFilter = 0;
 796 
                                if(LoggingGasCnt == 0) LoggingGasFilter = 0;
791 
                                LoggingGasFilter += (u32) FromFlightCtrl.Param.Byte[11];
 797 
                                LoggingGasFilter += (u32) FromFlightCtrl.Param.Byte[11];
792 
                                LoggingGasCnt++;
 798 
                                LoggingGasCnt++;
793 
                                break;
 799 
                                break;