Subversion Repositories NaviCtrl

Rev

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

Rev 736 Rev 738
Line 119... Line 119...
119
s32 ToFC_Rotate_C = 64, ToFC_Rotate_S = 0;
119
s32 ToFC_Rotate_C = 64, ToFC_Rotate_S = 0;
120
s32 HeadFreeStartAngle = 0;       // in 0,1°
120
s32 HeadFreeStartAngle = 0;       // in 0,1°
121
s32 CompassDirectionAtMotorStart = 0; // in 0,1°
121
s32 CompassDirectionAtMotorStart = 0; // in 0,1°
122
s16 FC_WP_EventChannel = 0, LogFC_WP_EventChannel = 0, FC_WP_EventChannel_Processed = 0; // gibt einen Schaltkanal an die FC weiter, wenn der Wegpunkt erreicht wurde
122
s16 FC_WP_EventChannel = 0, LogFC_WP_EventChannel = 0, FC_WP_EventChannel_Processed = 0; // gibt einen Schaltkanal an die FC weiter, wenn der Wegpunkt erreicht wurde
123
u32 ToFC_AltitudeRate = 0;
123
u32 ToFC_AltitudeRate = 0;
124
s32 ToFC_AltitudeSetpoint = 0;
124
s32 ToFC_AltitudeSetpoint_dm = 0;
125
u8  FromFC_VarioCharacter = ' ';
125
u8  FromFC_VarioCharacter = ' ';
126
s16 GPS_Aid_StickMultiplikator = 0;
126
s16 GPS_Aid_StickMultiplikator = 0;
127
u8 NC_GPS_ModeCharacter = ' ';
127
u8 NC_GPS_ModeCharacter = ' ';
128
u8 FCCalibActive = 0;
128
u8 FCCalibActive = 0;
129
u8 FC_is_Calibrated = 0;
129
u8 FC_is_Calibrated = 0;
Line 555... Line 555...
555
                                {
555
                                {
556
                                        ToFlightCtrl.Param.sInt[5] = tmp;
556
                                        ToFlightCtrl.Param.sInt[5] = tmp;
557
                                }
557
                                }
558
                                else
558
                                else
559
                                {
559
                                {
560
                                        ToFlightCtrl.Param.sInt[5] = (s16)ToFC_AltitudeSetpoint;
560
                                        ToFlightCtrl.Param.sInt[5] = (s16)ToFC_AltitudeSetpoint_dm;
561
                                }
561
                                }
562
//DebugOut.Analog[] = ToFlightCtrl.Param.Byte[8];
562
//DebugOut.Analog[] = ToFlightCtrl.Param.Byte[8];
563
                                break;
563
                                break;
564
                        case SPI_NCCMD_HOTT_INFO:
564
                        case SPI_NCCMD_HOTT_INFO:
565
                                if(NewWPL_Name) hott_index = 100;
565
                                if(NewWPL_Name) hott_index = 100;
Line 880... Line 880...
880
                                           Compass_SetCalState(CompassCalState);
880
                                           Compass_SetCalState(CompassCalState);
881
                                         }
881
                                         }
882
//                                       else CompassCalState = 0;
882
//                                       else CompassCalState = 0;
883
                                }
883
                                }
884
                                HoverGas = FromFlightCtrl.Param.Byte[1];
884
                                HoverGas = FromFlightCtrl.Param.Byte[1];
885
                                NaviData.Variometer = (NaviData.Variometer + 2 * (FromFlightCtrl.Param.sInt[1] - NaviData.Altimeter)) / 2; // provisorisch
885
                                NaviData.Variometer = (NaviData.Variometer + 2 * (FromFlightCtrl.Param.sInt[1] - NaviData.Altimeter_20cm)) / 2; // provisorisch
886
                                FC.Altimeter = FromFlightCtrl.Param.sInt[1]; // in 5cm
886
                                FC.Altimeter = FromFlightCtrl.Param.sInt[1]; // in 5cm
887
                                if(!(SimulationFlags & SIMULATION_ACTIVE)) NaviData.SetpointAltitude = FromFlightCtrl.Param.sInt[2]; // in 5cm
887
                                if(!(SimulationFlags & SIMULATION_ACTIVE)) NaviData.SetpointAltitude = FromFlightCtrl.Param.sInt[2]; // in 5cm
888
                                FC.Error[0]                     |= FromFlightCtrl.Param.Byte[6];
888
                                FC.Error[0]                     |= FromFlightCtrl.Param.Byte[6];
889
                                FC.Error[1]                     |= FromFlightCtrl.Param.Byte[7];
889
                                FC.Error[1]                     |= FromFlightCtrl.Param.Byte[7];
890
                                DebugOut.StatusGreen |= AMPEL_FC; // status of FC Present
890
                                DebugOut.StatusGreen |= AMPEL_FC; // status of FC Present