Rev 231 | Go to most recent revision | Show entire file | Regard whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 231 | Rev 232 | ||
---|---|---|---|
Line 315... | Line 315... | ||
315 | 315 | ||
316 | case SPI_NCCMD_GPSINFO: |
316 | case SPI_NCCMD_GPSINFO: |
317 | ToFlightCtrl.Param.Byte[0] = GPSData.Flags; |
317 | ToFlightCtrl.Param.Byte[0] = GPSData.Flags; |
318 | ToFlightCtrl.Param.Byte[1] = GPSData.NumOfSats; |
318 | ToFlightCtrl.Param.Byte[1] = GPSData.NumOfSats; |
319 | ToFlightCtrl.Param.Byte[2] = GPSData.SatFix; |
319 | ToFlightCtrl.Param.Byte[2] = GPSData.SatFix; |
320 | ToFlightCtrl.Param.Byte[3] = GPSData.Speed_Ground / 100; |
320 | ToFlightCtrl.Param.Byte[3] = GPSData.Speed_Ground / 100; // m/s |
321 | ToFlightCtrl.Param.Int[2] = NaviData.HomePositionDeviation.Distance; // dm |
321 | ToFlightCtrl.Param.Int[2] = NaviData.HomePositionDeviation.Distance; // dm |
322 | ToFlightCtrl.Param.sInt[3] = NaviData.HomePositionDeviation.Bearing; // deg |
322 | ToFlightCtrl.Param.sInt[3] = NaviData.HomePositionDeviation.Bearing; // deg |
323 | break; |
323 | break; |
324 | default: |
324 | default: |
Line 435... | Line 435... | ||
435 | FC_ErrorCode[0] = FromFlightCtrl.Param.Byte[5]; |
435 | FC_ErrorCode[0] = FromFlightCtrl.Param.Byte[5]; |
436 | FC_ErrorCode[1] = FromFlightCtrl.Param.Byte[6]; |
436 | FC_ErrorCode[1] = FromFlightCtrl.Param.Byte[6]; |
437 | FC_ErrorCode[2] = FromFlightCtrl.Param.Byte[7]; |
437 | FC_ErrorCode[2] = FromFlightCtrl.Param.Byte[7]; |
438 | DebugOut.Status[0] |= 0x01; // status of FC Present |
438 | DebugOut.Status[0] |= 0x01; // status of FC Present |
439 | DebugOut.Status[0] |= 0x02; // status of BL Present |
439 | DebugOut.Status[0] |= 0x02; // status of BL Present |
440 | if(FC_ErrorCode[0] || FC_ErrorCode[1] || FC_ErrorCode[2]) DebugOut.Status[1] |= 0x01; else DebugOut.Status[1] &= ~0x01; |
440 | if(FC_ErrorCode[0] || FC_ErrorCode[1] || FC_ErrorCode[2]) DebugOut.Status[1] |= 0x01; |
- | 441 | else DebugOut.Status[1] &= ~0x01; |
|
441 | break; |
442 | break; |
442 | default: |
443 | default: |
443 | break; |
444 | break; |
444 | } |
445 | } |