Subversion Repositories NaviCtrl

Rev

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

Rev 352 Rev 355
Line 343... Line 343...
343
                                }
343
                                }
344
                                ToFlightCtrl.Param.sInt[5] = POI_KameraNick;
344
                                ToFlightCtrl.Param.sInt[5] = POI_KameraNick;
345
                                break;
345
                                break;
Line 346... Line 346...
346
 
346
 
-
 
347
                        case SPI_NCCMD_VERSION:
-
 
348
                                //+++++++++++++++++++++++++++++++++++++++++++++++++++
-
 
349
                        //+ higher than the maximum allowed altitude
347
                        case SPI_NCCMD_VERSION:
350
                                //+++++++++++++++++++++++++++++++++++++++++++++++++++
348
                                ToFlightCtrl.Param.Byte[0] = VERSION_MAJOR;
351
                                ToFlightCtrl.Param.Byte[0] = VERSION_MAJOR;
349
                                ToFlightCtrl.Param.Byte[1] = VERSION_MINOR;
352
                                ToFlightCtrl.Param.Byte[1] = VERSION_MINOR;
350
                                ToFlightCtrl.Param.Byte[2] = VERSION_PATCH;
353
                                ToFlightCtrl.Param.Byte[2] = VERSION_PATCH;
351
                                ToFlightCtrl.Param.Byte[3] = FC_SPI_COMPATIBLE;
354
                                ToFlightCtrl.Param.Byte[3] = FC_SPI_COMPATIBLE;
Line 354... Line 357...
354
                                ToFlightCtrl.Param.Byte[6] = DebugOut.StatusRed;
357
                                ToFlightCtrl.Param.Byte[6] = DebugOut.StatusRed;
355
                                ToFlightCtrl.Param.Byte[7] = ErrorCode;
358
                                ToFlightCtrl.Param.Byte[7] = ErrorCode;
356
                                ToFlightCtrl.Param.Byte[8] = NC_GPS_ModeCharacter;
359
                                ToFlightCtrl.Param.Byte[8] = NC_GPS_ModeCharacter;
357
                                ToFlightCtrl.Param.Byte[9] = SerialLinkOkay;
360
                                ToFlightCtrl.Param.Byte[9] = SerialLinkOkay;
358
                                ToFlightCtrl.Param.Byte[10] = NC_To_FC_Flags;
361
                                ToFlightCtrl.Param.Byte[10] = NC_To_FC_Flags;
-
 
362
                                if(AbsoluteFlyingAltitude > 255) ToFlightCtrl.Param.Byte[11] = 0; // then the limitation of the FC doesn't work
359
                                ToFlightCtrl.Param.Byte[11] = 0;
363
                                else ToFlightCtrl.Param.Byte[11] = AbsoluteFlyingAltitude;
360
                                break;
364
                                break;
361
                        case SPI_MISC:
365
                        case SPI_MISC:
362
                                ToFlightCtrl.Param.Byte[0] = EarthMagneticFieldFiltered/5;
366
                                ToFlightCtrl.Param.Byte[0] = EarthMagneticFieldFiltered/5;
363
                                ToFlightCtrl.Param.Byte[1] = EarthMagneticInclination;
367
                                ToFlightCtrl.Param.Byte[1] = EarthMagneticInclination;
364
                                ToFlightCtrl.Param.Byte[2] = EarthMagneticInclinationTheoretic;
368
                                ToFlightCtrl.Param.Byte[2] = EarthMagneticInclinationTheoretic;