Rev 278 | Rev 280 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 278 | Rev 279 | ||
---|---|---|---|
Line 294... | Line 294... | ||
294 | ToFlightCtrl.Param.sByte[2] = (s8) Kalman_MaxDrift; |
294 | ToFlightCtrl.Param.sByte[2] = (s8) Kalman_MaxDrift; |
295 | ToFlightCtrl.Param.Byte[3] = (u8) SerialLinkOkay; |
295 | ToFlightCtrl.Param.Byte[3] = (u8) SerialLinkOkay; |
296 | ToFlightCtrl.Param.sByte[4] = (s8) ToFcGpsZ; |
296 | ToFlightCtrl.Param.sByte[4] = (s8) ToFcGpsZ; |
297 | ToFlightCtrl.Param.Byte[5] = (s8) ToFC_Rotate_C; |
297 | ToFlightCtrl.Param.Byte[5] = (s8) ToFC_Rotate_C; |
298 | ToFlightCtrl.Param.Byte[6] = (s8) ToFC_Rotate_S; |
298 | ToFlightCtrl.Param.Byte[6] = (s8) ToFC_Rotate_S; |
- | 299 | ToFlightCtrl.Param.sInt[5] = CAM_Orientation.Elevation; |
|
299 | if(CAM_Orientation.State == NEWDATA) |
300 | if(CAM_Orientation.State == NEWDATA) |
300 | { |
301 | { |
301 | ToFlightCtrl.Param.sInt[4] = CAM_Orientation.Azimuth; |
302 | ToFlightCtrl.Param.sInt[4] = CAM_Orientation.Azimuth; |
302 | ToFlightCtrl.Param.sInt[5] = CAM_Orientation.Elevation; |
- | |
303 | CAM_Orientation.State = PROCESSED; |
303 | CAM_Orientation.State = PROCESSED; |
304 | } |
304 | } |
305 | else |
305 | else |
306 | { // set invalid values |
306 | { // set invalid values |
307 | ToFlightCtrl.Param.sInt[4] = -1; |
307 | ToFlightCtrl.Param.sInt[4] = -1; |
308 | ToFlightCtrl.Param.sInt[5] = -1; |
- | |
309 | } |
308 | } |
- | 309 | DebugOut.Analog[24] = ToFlightCtrl.Param.sInt[5]; |
|
310 | break; |
310 | break; |
Line 311... | Line 311... | ||
311 | 311 | ||
312 | case SPI_NCCMD_VERSION: |
312 | case SPI_NCCMD_VERSION: |
313 | ToFlightCtrl.Param.Byte[0] = VERSION_MAJOR; |
313 | ToFlightCtrl.Param.Byte[0] = VERSION_MAJOR; |