296,17 → 296,17 |
ToFlightCtrl.Param.sByte[4] = (s8) ToFcGpsZ; |
ToFlightCtrl.Param.Byte[5] = (s8) ToFC_Rotate_C; |
ToFlightCtrl.Param.Byte[6] = (s8) ToFC_Rotate_S; |
ToFlightCtrl.Param.sInt[5] = CAM_Orientation.Elevation; |
if(CAM_Orientation.State == NEWDATA) |
{ |
ToFlightCtrl.Param.sInt[4] = CAM_Orientation.Azimuth; |
ToFlightCtrl.Param.sInt[5] = CAM_Orientation.Elevation; |
CAM_Orientation.State = PROCESSED; |
} |
else |
{ // set invalid values |
ToFlightCtrl.Param.sInt[4] = -1; |
ToFlightCtrl.Param.sInt[5] = -1; |
} |
DebugOut.Analog[24] = ToFlightCtrl.Param.sInt[5]; |
break; |
|
case SPI_NCCMD_VERSION: |