Subversion Repositories FlightCtrl

Rev

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

Rev 2443 Rev 2447
Line 29... Line 29...
29
unsigned char NC_ErrorCode = 0;
29
unsigned char NC_ErrorCode = 0;
30
unsigned char NC_GPS_ModeCharacter = ' ';
30
unsigned char NC_GPS_ModeCharacter = ' ';
31
unsigned char EarthMagneticField = 0;
31
unsigned char EarthMagneticField = 0;
32
unsigned char EarthMagneticInclination = 0, EarthMagneticInclinationTheoretic = 0;
32
unsigned char EarthMagneticInclination = 0, EarthMagneticInclinationTheoretic = 0;
33
unsigned char NC_To_FC_Flags = 0;
33
unsigned char NC_To_FC_Flags = 0;
34
unsigned char NC_To_FC_MaxAltitude = 0; // this is a Parameter on the SD-card
34
//unsigned char NC_To_FC_MaxAltitude = 0; // this is a Parameter on the SD-card
35
signed int POI_KameraNick = 0; // in 0,1°
35
signed int POI_KameraNick = 0; // in 0,1°
36
vector16_t MagVec = {0,0,0};
36
vector16_t MagVec = {0,0,0};
Line 37... Line 37...
37
 
37
 
Line 200... Line 200...
200
                                ToNaviCtrl.Param.Byte[3] = EE_Parameter.NaviGpsI;
200
                                ToNaviCtrl.Param.Byte[3] = EE_Parameter.NaviGpsI;
201
                                ToNaviCtrl.Param.Byte[4] = EE_Parameter.NaviGpsD;
201
                                ToNaviCtrl.Param.Byte[4] = EE_Parameter.NaviGpsD;
202
                                ToNaviCtrl.Param.Byte[5] = EE_Parameter.NaviGpsA;
202
                                ToNaviCtrl.Param.Byte[5] = EE_Parameter.NaviGpsA;
203
                                ToNaviCtrl.Param.Byte[6] = EE_Parameter.NaviGpsMinSat;
203
                                ToNaviCtrl.Param.Byte[6] = EE_Parameter.NaviGpsMinSat;
204
                ToNaviCtrl.Param.Byte[7] = EE_Parameter.NaviStickThreshold;
204
                ToNaviCtrl.Param.Byte[7] = EE_Parameter.NaviStickThreshold;
205
                ToNaviCtrl.Param.Byte[8] = EE_Parameter.NaviOperatingRadius;
205
                ToNaviCtrl.Param.Byte[8] = EE_Parameter.NaviMaxFlyingRange;
206
                ToNaviCtrl.Param.Byte[9] = EE_Parameter.NaviWindCorrection;
206
                ToNaviCtrl.Param.Byte[9] = EE_Parameter.NaviWindCorrection;
207
                ToNaviCtrl.Param.Byte[10] = EE_Parameter.NaviAccCompensation;
207
                ToNaviCtrl.Param.Byte[10] = EE_Parameter.NaviAccCompensation;
208
                                ToNaviCtrl.Param.Byte[11] = EE_Parameter.NaviAngleLimitation;
208
                                ToNaviCtrl.Param.Byte[11] = EE_Parameter.NaviAngleLimitation;
209
            break;
209
            break;
210
         case SPI_FCCMD_PARAMETER2:
210
         case SPI_FCCMD_PARAMETER2:
Line 290... Line 290...
290
                        ToNaviCtrl.Param.Int[0] = Capacity.UsedCapacity; // mAh
290
                        ToNaviCtrl.Param.Int[0] = Capacity.UsedCapacity; // mAh
291
                        ToNaviCtrl.Param.Byte[2] = Parameter_ServoNickControl;
291
                        ToNaviCtrl.Param.Byte[2] = Parameter_ServoNickControl;
292
                        ToNaviCtrl.Param.Byte[3] = Parameter_ServoRollControl;
292
                        ToNaviCtrl.Param.Byte[3] = Parameter_ServoRollControl;
293
                        ToNaviCtrl.Param.Byte[4] = DebugOut.Analog[28]; // I2C-Error counter
293
                        ToNaviCtrl.Param.Byte[4] = DebugOut.Analog[28]; // I2C-Error counter
294
                        ToNaviCtrl.Param.Byte[5] = RedundanceBlOperation;
294
                        ToNaviCtrl.Param.Byte[5] = RedundanceBlOperation;
-
 
295
                        ToNaviCtrl.Param.Byte[6] = EE_Parameter.NaviDescendRange; // in 10m
-
 
296
                        ToNaviCtrl.Param.Byte[7] = Parameter_MaximumAltitude;
-
 
297
                        ToNaviCtrl.Param.Int[4] = FlugMinutenGesamt; // 8 & 9
295
/*
298
/*
296
                ToNaviCtrl.Param.Byte[6] = 0;
-
 
297
                ToNaviCtrl.Param.Byte[7] = 0;
-
 
298
                ToNaviCtrl.Param.Byte[8] = 0;
-
 
299
                ToNaviCtrl.Param.Byte[9] = 0;
-
 
300
                ToNaviCtrl.Param.Byte[10] = 0;
299
                ToNaviCtrl.Param.Byte[10] = 0;
301
                ToNaviCtrl.Param.Byte[11] = 0;
300
                ToNaviCtrl.Param.Byte[11] = 0;
302
*/
301
*/
303
                break;
302
                break;
304
        }
303
        }
Line 355... Line 354...
355
                        DebugOut.Status[1] = (DebugOut.Status[1] & (0x01|0x02)) | (FromNaviCtrl.Param.Byte[6] & (0x04 | 0x08));
354
                        DebugOut.Status[1] = (DebugOut.Status[1] & (0x01|0x02)) | (FromNaviCtrl.Param.Byte[6] & (0x04 | 0x08));
356
                        NC_ErrorCode = FromNaviCtrl.Param.Byte[7];
355
                        NC_ErrorCode = FromNaviCtrl.Param.Byte[7];
357
                        NC_GPS_ModeCharacter = FromNaviCtrl.Param.Byte[8];
356
                        NC_GPS_ModeCharacter = FromNaviCtrl.Param.Byte[8];
358
                        FromNaviCtrl_Value.SerialDataOkay = FromNaviCtrl.Param.Byte[9];
357
                        FromNaviCtrl_Value.SerialDataOkay = FromNaviCtrl.Param.Byte[9];
359
                        NC_To_FC_Flags = FromNaviCtrl.Param.Byte[10];
358
                        NC_To_FC_Flags = FromNaviCtrl.Param.Byte[10];
360
                        NC_To_FC_MaxAltitude = FromNaviCtrl.Param.Byte[11];
359
//NC_To_FC_MaxAltitude = FromNaviCtrl.Param.Byte[11];
361
                        break;
360
                        break;
362
                case SPI_NCCMD_GPSINFO:
361
                case SPI_NCCMD_GPSINFO:
363
                        GPSInfo.Flags = FromNaviCtrl.Param.Byte[0];
362
                        GPSInfo.Flags = FromNaviCtrl.Param.Byte[0];
364
                        GPSInfo.NumOfSats = FromNaviCtrl.Param.Byte[1];
363
                        GPSInfo.NumOfSats = FromNaviCtrl.Param.Byte[1];
365
                        GPSInfo.SatFix = FromNaviCtrl.Param.Byte[2];
364
                        GPSInfo.SatFix = FromNaviCtrl.Param.Byte[2];