Subversion Repositories NaviCtrl

Rev

Rev 231 | Rev 233 | Go to most recent revision | Show entire file | Ignore 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 434... Line 434...
434 
                                FC_Version.Hardware             = FromFlightCtrl.Param.Byte[4];
 434 
                                FC_Version.Hardware             = FromFlightCtrl.Param.Byte[4];
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 
                }