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]; |