Subversion Repositories FlightCtrl

Rev

Rev 2084 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 2084 Rev 2088
Line 70... Line 70...
70
} UBX_VELNED_t;
70
} UBX_VELNED_t;
Line 71... Line 71...
71
 
71
 
72
UBX_SOL_t ubxSol = { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, INVALID };
72
UBX_SOL_t ubxSol = { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, INVALID };
73
UBX_POSLLH_t ubxPosLlh = { 0, 0, 0, 0, 0, 0, 0, INVALID };
73
UBX_POSLLH_t ubxPosLlh = { 0, 0, 0, 0, 0, 0, 0, INVALID };
74
UBX_VELNED_t ubxVelNed = { 0, 0, 0, 0, 0, 0, 0, 0, 0, INVALID };
74
UBX_VELNED_t ubxVelNed = { 0, 0, 0, 0, 0, 0, 0, 0, 0, INVALID };
Line 75... Line 75...
75
GPS_INFO_t GPSInfo = { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, INVALID };
75
GPS_INFO_t GPSInfo = { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, INVALID };
76
 
76
 
Line 77... Line 77...
77
volatile uint8_t GPSTimeout = 0;
77
volatile uint8_t GPSTimeout = 0;
Line 86... Line 86...
86
      GPSInfo.status = INVALID;
86
      GPSInfo.status = INVALID;
87
      // NAV SOL
87
      // NAV SOL
88
      GPSInfo.flags =   ubxSol.flags;
88
      GPSInfo.flags =   ubxSol.flags;
89
      GPSInfo.satfix =  ubxSol.GPSfix;
89
      GPSInfo.satfix =  ubxSol.GPSfix;
90
      GPSInfo.satnum =  ubxSol.numSV;
90
      GPSInfo.satnum =  ubxSol.numSV;
-
 
91
 
91
      GPSInfo.PAcc =    ubxSol.pAcc;
92
      GPSInfo.position3DAcc =  ubxSol.pAcc;
-
 
93
      GPSInfo.verticalAcc =    ubxPosLlh.vAacc;
92
      GPSInfo.VAcc =    ubxSol.sAcc;
94
      GPSInfo.velocityAcc =    ubxSol.sAcc;
-
 
95
 
-
 
96
      debugOut.analog[30] = ubxPosLlh.HMSL/1000L;
93
      debugOut.analog[31] = GPSInfo.VAcc;
97
      debugOut.analog[31] = GPSInfo.verticalAcc/1000L;
Line 94... Line 98...
94
 
98
 
95
      // NAV POSLLH
99
      // NAV POSLLH
96
      GPSInfo.longitude =   ubxPosLlh.lon;
100
      GPSInfo.longitude =   ubxPosLlh.lon;
97
      GPSInfo.latitude =    ubxPosLlh.lat;
101
      GPSInfo.latitude =    ubxPosLlh.lat;