Subversion Repositories NaviCtrl

Rev

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

Rev 540 Rev 544
Line 353... Line 353...
353 
                                ToFlightCtrl.Param.Byte[5] = (s8) ToFC_Rotate_C;
 353 
                                ToFlightCtrl.Param.Byte[5] = (s8) ToFC_Rotate_C;
354 
                                ToFlightCtrl.Param.Byte[6] = (s8) ToFC_Rotate_S;
 354 
                                ToFlightCtrl.Param.Byte[6] = (s8) ToFC_Rotate_S;
355 
                                ToFlightCtrl.Param.Byte[7] = GPS_Aid_StickMultiplikator;
 355 
                                ToFlightCtrl.Param.Byte[7] = GPS_Aid_StickMultiplikator;
356 
                                if(CAM_Orientation.UpdateMask & CAM_UPDATE_AZIMUTH)
 356 
                                if(CAM_Orientation.UpdateMask & CAM_UPDATE_AZIMUTH)
357 
                                {
 357 
                                {
358 
                                        if(CAM_Orientation.Azimuth != -1) ToFlightCtrl.Param.sInt[4] = (CAM_Orientation.Azimuth + (3*360) - (FC.FromFC_CompassOffset / 10 + GeoMagDec/10 + Parameter.OrientationAngle * 15)) % 360;  // the FC uses the uncorrected comnpass value
 358 
//                                      if(CAM_Orientation.Azimuth != -1) ToFlightCtrl.Param.sInt[4] = (CAM_Orientation.Azimuth + (3*360) - (FC.FromFC_CompassOffset / 10 + GeoMagDec/10 + Parameter.OrientationAngle * 15)) % 360;  // the FC uses the uncorrected comnpass value
- 
 
 359 
                                        if(CAM_Orientation.Azimuth != -1) ToFlightCtrl.Param.sInt[4] = (CAM_Orientation.Azimuth + (3*360) - (FC.FromFC_CompassOffset / 10 + GeoMagDec/10 + Parameter.CamOrientation * 15)) % 360;  // the FC uses the uncorrected comnpass value
359 
                                        else CAM_Orientation.Azimuth = -1;
 360 
                                        else CAM_Orientation.Azimuth = -1;
360 
                                        CAM_Orientation.UpdateMask &= ~CAM_UPDATE_AZIMUTH;
 361 
                                        CAM_Orientation.UpdateMask &= ~CAM_UPDATE_AZIMUTH;
361 
                                }
 362 
                                }
362 
                                else
 363 
                                else
363 
                                {
 364 
                                {
Line 762... Line 763...
762 
                                FC_I2C_ErrorConter = FromFlightCtrl.Param.Byte[4];
 763 
                                FC_I2C_ErrorConter = FromFlightCtrl.Param.Byte[4];
763 
                                FC.RedundanceBlOperation = FromFlightCtrl.Param.Byte[5];
 764 
                                FC.RedundanceBlOperation = FromFlightCtrl.Param.Byte[5];
764 
                                Parameter.DescendRange = FromFlightCtrl.Param.Byte[6];
 765 
                                Parameter.DescendRange = FromFlightCtrl.Param.Byte[6];
765 
                                Parameter.MaximumAltitude = FromFlightCtrl.Param.Byte[7];
 766 
                                Parameter.MaximumAltitude = FromFlightCtrl.Param.Byte[7];
766 
                                FlugMinutenGesamt = FromFlightCtrl.Param.Int[4]; // 8 & 9
 767 
                                FlugMinutenGesamt = FromFlightCtrl.Param.Int[4]; // 8 & 9
- 
 
 768 
                                Parameter.CamOrientation = FromFlightCtrl.Param.Byte[10];
767 
                                break;
 769 
                                break;
Line 768... Line 770...
768 
 
 770 
 
769 
                        case SPI_FCCMD_VERSION:
 771 
                        case SPI_FCCMD_VERSION:
770 
                                FC_Version.Major                = FromFlightCtrl.Param.Byte[0];
 772 
                                FC_Version.Major                = FromFlightCtrl.Param.Byte[0];