1 /* Copyright (c) 2017-2019, The Linux Foundation. All rights reserved.
2 *
3 * Redistribution and use in source and binary forms, with or without
4 * modification, are permitted provided that the following conditions are
5 * met:
6 * * Redistributions of source code must retain the above copyright
7 * notice, this list of conditions and the following disclaimer.
8 * * Redistributions in binary form must reproduce the above
9 * copyright notice, this list of conditions and the following
10 * disclaimer in the documentation and/or other materials provided
11 * with the distribution.
12 * * Neither the name of The Linux Foundation, nor the names of its
13 * contributors may be used to endorse or promote products derived
14 * from this software without specific prior written permission.
15 *
16 * THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
17 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
18 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
19 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
20 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
21 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
22 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
23 * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
24 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
25 * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
26 * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 *
28 */
29
30 #define LOG_NDEBUG 0
31 #define LOG_TAG "LocSvc_MeasurementAPIClient"
32
33 #include <log_util.h>
34 #include <loc_cfg.h>
35 #include <inttypes.h>
36
37 #include "LocationUtil.h"
38 #include "MeasurementAPIClient.h"
39
40 namespace android {
41 namespace hardware {
42 namespace gnss {
43 namespace V2_0 {
44 namespace implementation {
45
46 using ::android::hardware::gnss::V1_0::IGnssMeasurement;
47 using ::android::hardware::gnss::V2_0::IGnssMeasurementCallback;
48
49 static void convertGnssData(GnssMeasurementsNotification& in,
50 V1_0::IGnssMeasurementCallback::GnssData& out);
51 static void convertGnssData_1_1(GnssMeasurementsNotification& in,
52 V1_1::IGnssMeasurementCallback::GnssData& out);
53 static void convertGnssData_2_0(GnssMeasurementsNotification& in,
54 V2_0::IGnssMeasurementCallback::GnssData& out);
55 static void convertGnssMeasurement(GnssMeasurementsData& in,
56 V1_0::IGnssMeasurementCallback::GnssMeasurement& out);
57 static void convertGnssClock(GnssMeasurementsClock& in, IGnssMeasurementCallback::GnssClock& out);
58 static void convertGnssMeasurementsCodeType(GnssMeasurementsCodeType& in,
59 ::android::hardware::hidl_string& out);
60
MeasurementAPIClient()61 MeasurementAPIClient::MeasurementAPIClient() :
62 mGnssMeasurementCbIface(nullptr),
63 mGnssMeasurementCbIface_1_1(nullptr),
64 mGnssMeasurementCbIface_2_0(nullptr),
65 mTracking(false)
66 {
67 LOC_LOGD("%s]: ()", __FUNCTION__);
68 }
69
~MeasurementAPIClient()70 MeasurementAPIClient::~MeasurementAPIClient()
71 {
72 LOC_LOGD("%s]: ()", __FUNCTION__);
73 }
74
75 // for GpsInterface
76 Return<IGnssMeasurement::GnssMeasurementStatus>
measurementSetCallback(const sp<V1_0::IGnssMeasurementCallback> & callback)77 MeasurementAPIClient::measurementSetCallback(const sp<V1_0::IGnssMeasurementCallback>& callback)
78 {
79 LOC_LOGD("%s]: (%p)", __FUNCTION__, &callback);
80
81 mMutex.lock();
82 mGnssMeasurementCbIface = callback;
83 mMutex.unlock();
84
85 return startTracking();
86 }
87
88 Return<IGnssMeasurement::GnssMeasurementStatus>
measurementSetCallback_1_1(const sp<V1_1::IGnssMeasurementCallback> & callback,GnssPowerMode powerMode,uint32_t timeBetweenMeasurement)89 MeasurementAPIClient::measurementSetCallback_1_1(
90 const sp<V1_1::IGnssMeasurementCallback>& callback,
91 GnssPowerMode powerMode, uint32_t timeBetweenMeasurement)
92 {
93 LOC_LOGD("%s]: (%p) (powermode: %d) (tbm: %d)",
94 __FUNCTION__, &callback, (int)powerMode, timeBetweenMeasurement);
95
96 mMutex.lock();
97 mGnssMeasurementCbIface_1_1 = callback;
98 mMutex.unlock();
99
100 return startTracking(powerMode, timeBetweenMeasurement);
101 }
102
103 Return<IGnssMeasurement::GnssMeasurementStatus>
measurementSetCallback_2_0(const sp<V2_0::IGnssMeasurementCallback> & callback,GnssPowerMode powerMode,uint32_t timeBetweenMeasurement)104 MeasurementAPIClient::measurementSetCallback_2_0(
105 const sp<V2_0::IGnssMeasurementCallback>& callback,
106 GnssPowerMode powerMode, uint32_t timeBetweenMeasurement)
107 {
108 LOC_LOGD("%s]: (%p) (powermode: %d) (tbm: %d)",
109 __FUNCTION__, &callback, (int)powerMode, timeBetweenMeasurement);
110
111 mMutex.lock();
112 mGnssMeasurementCbIface_2_0 = callback;
113 mMutex.unlock();
114
115 return startTracking(powerMode, timeBetweenMeasurement);
116 }
117
118 Return<IGnssMeasurement::GnssMeasurementStatus>
startTracking(GnssPowerMode powerMode,uint32_t timeBetweenMeasurement)119 MeasurementAPIClient::startTracking(
120 GnssPowerMode powerMode, uint32_t timeBetweenMeasurement)
121 {
122 LocationCallbacks locationCallbacks;
123 memset(&locationCallbacks, 0, sizeof(LocationCallbacks));
124 locationCallbacks.size = sizeof(LocationCallbacks);
125
126 locationCallbacks.trackingCb = nullptr;
127 locationCallbacks.batchingCb = nullptr;
128 locationCallbacks.geofenceBreachCb = nullptr;
129 locationCallbacks.geofenceStatusCb = nullptr;
130 locationCallbacks.gnssLocationInfoCb = nullptr;
131 locationCallbacks.gnssNiCb = nullptr;
132 locationCallbacks.gnssSvCb = nullptr;
133 locationCallbacks.gnssNmeaCb = nullptr;
134
135 locationCallbacks.gnssMeasurementsCb = nullptr;
136 if (mGnssMeasurementCbIface_2_0 != nullptr ||
137 mGnssMeasurementCbIface_1_1 != nullptr ||
138 mGnssMeasurementCbIface != nullptr) {
139 locationCallbacks.gnssMeasurementsCb =
140 [this](GnssMeasurementsNotification gnssMeasurementsNotification) {
141 onGnssMeasurementsCb(gnssMeasurementsNotification);
142 };
143 }
144
145 locAPISetCallbacks(locationCallbacks);
146
147 TrackingOptions options = {};
148 memset(&options, 0, sizeof(TrackingOptions));
149 options.size = sizeof(TrackingOptions);
150 options.minInterval = 1000;
151 options.mode = GNSS_SUPL_MODE_STANDALONE;
152 if (GNSS_POWER_MODE_INVALID != powerMode) {
153 options.powerMode = powerMode;
154 options.tbm = timeBetweenMeasurement;
155 }
156
157 mTracking = true;
158 LOC_LOGD("%s]: start tracking session", __FUNCTION__);
159 locAPIStartTracking(options);
160 return IGnssMeasurement::GnssMeasurementStatus::SUCCESS;
161 }
162
163 // for GpsMeasurementInterface
measurementClose()164 void MeasurementAPIClient::measurementClose() {
165 LOC_LOGD("%s]: ()", __FUNCTION__);
166 mTracking = false;
167 locAPIStopTracking();
168 }
169
170 // callbacks
onGnssMeasurementsCb(GnssMeasurementsNotification gnssMeasurementsNotification)171 void MeasurementAPIClient::onGnssMeasurementsCb(
172 GnssMeasurementsNotification gnssMeasurementsNotification)
173 {
174 LOC_LOGD("%s]: (count: %u active: %d)",
175 __FUNCTION__, gnssMeasurementsNotification.count, mTracking);
176 if (mTracking) {
177 mMutex.lock();
178 sp<V1_0::IGnssMeasurementCallback> gnssMeasurementCbIface = nullptr;
179 sp<V1_1::IGnssMeasurementCallback> gnssMeasurementCbIface_1_1 = nullptr;
180 sp<V2_0::IGnssMeasurementCallback> gnssMeasurementCbIface_2_0 = nullptr;
181 if (mGnssMeasurementCbIface_2_0 != nullptr) {
182 gnssMeasurementCbIface_2_0 = mGnssMeasurementCbIface_2_0;
183 } else if (mGnssMeasurementCbIface_1_1 != nullptr) {
184 gnssMeasurementCbIface_1_1 = mGnssMeasurementCbIface_1_1;
185 } else if (mGnssMeasurementCbIface != nullptr) {
186 gnssMeasurementCbIface = mGnssMeasurementCbIface;
187 }
188 mMutex.unlock();
189
190 if (gnssMeasurementCbIface_2_0 != nullptr) {
191 V2_0::IGnssMeasurementCallback::GnssData gnssData;
192 convertGnssData_2_0(gnssMeasurementsNotification, gnssData);
193 auto r = gnssMeasurementCbIface_2_0->gnssMeasurementCb_2_0(gnssData);
194 if (!r.isOk()) {
195 LOC_LOGE("%s] Error from gnssMeasurementCb description=%s",
196 __func__, r.description().c_str());
197 }
198 } else if (gnssMeasurementCbIface_1_1 != nullptr) {
199 V1_1::IGnssMeasurementCallback::GnssData gnssData;
200 convertGnssData_1_1(gnssMeasurementsNotification, gnssData);
201 auto r = gnssMeasurementCbIface_1_1->gnssMeasurementCb(gnssData);
202 if (!r.isOk()) {
203 LOC_LOGE("%s] Error from gnssMeasurementCb description=%s",
204 __func__, r.description().c_str());
205 }
206 } else if (gnssMeasurementCbIface != nullptr) {
207 V1_0::IGnssMeasurementCallback::GnssData gnssData;
208 convertGnssData(gnssMeasurementsNotification, gnssData);
209 auto r = gnssMeasurementCbIface->GnssMeasurementCb(gnssData);
210 if (!r.isOk()) {
211 LOC_LOGE("%s] Error from GnssMeasurementCb description=%s",
212 __func__, r.description().c_str());
213 }
214 }
215 }
216 }
217
convertGnssMeasurement(GnssMeasurementsData & in,V1_0::IGnssMeasurementCallback::GnssMeasurement & out)218 static void convertGnssMeasurement(GnssMeasurementsData& in,
219 V1_0::IGnssMeasurementCallback::GnssMeasurement& out)
220 {
221 memset(&out, 0, sizeof(out));
222 if (in.flags & GNSS_MEASUREMENTS_DATA_SIGNAL_TO_NOISE_RATIO_BIT)
223 out.flags |= IGnssMeasurementCallback::GnssMeasurementFlags::HAS_SNR;
224 if (in.flags & GNSS_MEASUREMENTS_DATA_CARRIER_FREQUENCY_BIT)
225 out.flags |= IGnssMeasurementCallback::GnssMeasurementFlags::HAS_CARRIER_FREQUENCY;
226 if (in.flags & GNSS_MEASUREMENTS_DATA_CARRIER_CYCLES_BIT)
227 out.flags |= IGnssMeasurementCallback::GnssMeasurementFlags::HAS_CARRIER_CYCLES;
228 if (in.flags & GNSS_MEASUREMENTS_DATA_CARRIER_PHASE_BIT)
229 out.flags |= IGnssMeasurementCallback::GnssMeasurementFlags::HAS_CARRIER_PHASE;
230 if (in.flags & GNSS_MEASUREMENTS_DATA_CARRIER_PHASE_UNCERTAINTY_BIT)
231 out.flags |= IGnssMeasurementCallback::GnssMeasurementFlags::HAS_CARRIER_PHASE_UNCERTAINTY;
232 if (in.flags & GNSS_MEASUREMENTS_DATA_AUTOMATIC_GAIN_CONTROL_BIT)
233 out.flags |= IGnssMeasurementCallback::GnssMeasurementFlags::HAS_AUTOMATIC_GAIN_CONTROL;
234 out.svid = in.svId;
235 convertGnssConstellationType(in.svType, out.constellation);
236 out.timeOffsetNs = in.timeOffsetNs;
237 if (in.stateMask & GNSS_MEASUREMENTS_STATE_CODE_LOCK_BIT)
238 out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_CODE_LOCK;
239 if (in.stateMask & GNSS_MEASUREMENTS_STATE_BIT_SYNC_BIT)
240 out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_BIT_SYNC;
241 if (in.stateMask & GNSS_MEASUREMENTS_STATE_SUBFRAME_SYNC_BIT)
242 out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_SUBFRAME_SYNC;
243 if (in.stateMask & GNSS_MEASUREMENTS_STATE_TOW_DECODED_BIT)
244 out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_TOW_DECODED;
245 if (in.stateMask & GNSS_MEASUREMENTS_STATE_MSEC_AMBIGUOUS_BIT)
246 out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_MSEC_AMBIGUOUS;
247 if (in.stateMask & GNSS_MEASUREMENTS_STATE_SYMBOL_SYNC_BIT)
248 out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_SYMBOL_SYNC;
249 if (in.stateMask & GNSS_MEASUREMENTS_STATE_GLO_STRING_SYNC_BIT)
250 out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_GLO_STRING_SYNC;
251 if (in.stateMask & GNSS_MEASUREMENTS_STATE_GLO_TOD_DECODED_BIT)
252 out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_GLO_TOD_DECODED;
253 if (in.stateMask & GNSS_MEASUREMENTS_STATE_BDS_D2_BIT_SYNC_BIT)
254 out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_BDS_D2_BIT_SYNC;
255 if (in.stateMask & GNSS_MEASUREMENTS_STATE_BDS_D2_SUBFRAME_SYNC_BIT)
256 out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_BDS_D2_SUBFRAME_SYNC;
257 if (in.stateMask & GNSS_MEASUREMENTS_STATE_GAL_E1BC_CODE_LOCK_BIT)
258 out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_GAL_E1BC_CODE_LOCK;
259 if (in.stateMask & GNSS_MEASUREMENTS_STATE_GAL_E1C_2ND_CODE_LOCK_BIT)
260 out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_GAL_E1C_2ND_CODE_LOCK;
261 if (in.stateMask & GNSS_MEASUREMENTS_STATE_GAL_E1B_PAGE_SYNC_BIT)
262 out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_GAL_E1B_PAGE_SYNC;
263 if (in.stateMask & GNSS_MEASUREMENTS_STATE_SBAS_SYNC_BIT)
264 out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_SBAS_SYNC;
265 out.receivedSvTimeInNs = in.receivedSvTimeNs;
266 out.receivedSvTimeUncertaintyInNs = in.receivedSvTimeUncertaintyNs;
267 out.cN0DbHz = in.carrierToNoiseDbHz;
268 out.pseudorangeRateMps = in.pseudorangeRateMps;
269 out.pseudorangeRateUncertaintyMps = in.pseudorangeRateUncertaintyMps;
270 if (in.adrStateMask & GNSS_MEASUREMENTS_ACCUMULATED_DELTA_RANGE_STATE_VALID_BIT)
271 out.accumulatedDeltaRangeState |=
272 IGnssMeasurementCallback::GnssAccumulatedDeltaRangeState::ADR_STATE_VALID;
273 if (in.adrStateMask & GNSS_MEASUREMENTS_ACCUMULATED_DELTA_RANGE_STATE_RESET_BIT)
274 out.accumulatedDeltaRangeState |=
275 IGnssMeasurementCallback::GnssAccumulatedDeltaRangeState::ADR_STATE_RESET;
276 if (in.adrStateMask & GNSS_MEASUREMENTS_ACCUMULATED_DELTA_RANGE_STATE_CYCLE_SLIP_BIT)
277 out.accumulatedDeltaRangeState |=
278 IGnssMeasurementCallback::GnssAccumulatedDeltaRangeState::ADR_STATE_CYCLE_SLIP;
279 out.accumulatedDeltaRangeM = in.adrMeters;
280 out.accumulatedDeltaRangeUncertaintyM = in.adrUncertaintyMeters;
281 out.carrierFrequencyHz = in.carrierFrequencyHz;
282 out.carrierCycles = in.carrierCycles;
283 out.carrierPhase = in.carrierPhase;
284 out.carrierPhaseUncertainty = in.carrierPhaseUncertainty;
285 uint8_t indicator =
286 static_cast<uint8_t>(IGnssMeasurementCallback::GnssMultipathIndicator::INDICATOR_UNKNOWN);
287 if (in.multipathIndicator & GNSS_MEASUREMENTS_MULTIPATH_INDICATOR_PRESENT)
288 indicator |= IGnssMeasurementCallback::GnssMultipathIndicator::INDICATOR_PRESENT;
289 if (in.multipathIndicator & GNSS_MEASUREMENTS_MULTIPATH_INDICATOR_NOT_PRESENT)
290 indicator |= IGnssMeasurementCallback::GnssMultipathIndicator::INDICATIOR_NOT_PRESENT;
291 out.multipathIndicator =
292 static_cast<IGnssMeasurementCallback::GnssMultipathIndicator>(indicator);
293 out.snrDb = in.signalToNoiseRatioDb;
294 out.agcLevelDb = in.agcLevelDb;
295 }
296
convertGnssClock(GnssMeasurementsClock & in,IGnssMeasurementCallback::GnssClock & out)297 static void convertGnssClock(GnssMeasurementsClock& in, IGnssMeasurementCallback::GnssClock& out)
298 {
299 memset(&out, 0, sizeof(out));
300 if (in.flags & GNSS_MEASUREMENTS_CLOCK_FLAGS_LEAP_SECOND_BIT)
301 out.gnssClockFlags |= IGnssMeasurementCallback::GnssClockFlags::HAS_LEAP_SECOND;
302 if (in.flags & GNSS_MEASUREMENTS_CLOCK_FLAGS_TIME_UNCERTAINTY_BIT)
303 out.gnssClockFlags |= IGnssMeasurementCallback::GnssClockFlags::HAS_TIME_UNCERTAINTY;
304 if (in.flags & GNSS_MEASUREMENTS_CLOCK_FLAGS_FULL_BIAS_BIT)
305 out.gnssClockFlags |= IGnssMeasurementCallback::GnssClockFlags::HAS_FULL_BIAS;
306 if (in.flags & GNSS_MEASUREMENTS_CLOCK_FLAGS_BIAS_BIT)
307 out.gnssClockFlags |= IGnssMeasurementCallback::GnssClockFlags::HAS_BIAS;
308 if (in.flags & GNSS_MEASUREMENTS_CLOCK_FLAGS_BIAS_UNCERTAINTY_BIT)
309 out.gnssClockFlags |= IGnssMeasurementCallback::GnssClockFlags::HAS_BIAS_UNCERTAINTY;
310 if (in.flags & GNSS_MEASUREMENTS_CLOCK_FLAGS_DRIFT_BIT)
311 out.gnssClockFlags |= IGnssMeasurementCallback::GnssClockFlags::HAS_DRIFT;
312 if (in.flags & GNSS_MEASUREMENTS_CLOCK_FLAGS_DRIFT_UNCERTAINTY_BIT)
313 out.gnssClockFlags |= IGnssMeasurementCallback::GnssClockFlags::HAS_DRIFT_UNCERTAINTY;
314 out.leapSecond = in.leapSecond;
315 out.timeNs = in.timeNs;
316 out.timeUncertaintyNs = in.timeUncertaintyNs;
317 out.fullBiasNs = in.fullBiasNs;
318 out.biasNs = in.biasNs;
319 out.biasUncertaintyNs = in.biasUncertaintyNs;
320 out.driftNsps = in.driftNsps;
321 out.driftUncertaintyNsps = in.driftUncertaintyNsps;
322 out.hwClockDiscontinuityCount = in.hwClockDiscontinuityCount;
323 }
324
convertGnssData(GnssMeasurementsNotification & in,V1_0::IGnssMeasurementCallback::GnssData & out)325 static void convertGnssData(GnssMeasurementsNotification& in,
326 V1_0::IGnssMeasurementCallback::GnssData& out)
327 {
328 memset(&out, 0, sizeof(out));
329 out.measurementCount = in.count;
330 if (out.measurementCount > static_cast<uint32_t>(V1_0::GnssMax::SVS_COUNT)) {
331 LOC_LOGW("%s]: Too many measurement %u. Clamps to %d.",
332 __FUNCTION__, out.measurementCount, V1_0::GnssMax::SVS_COUNT);
333 out.measurementCount = static_cast<uint32_t>(V1_0::GnssMax::SVS_COUNT);
334 }
335 for (size_t i = 0; i < out.measurementCount; i++) {
336 convertGnssMeasurement(in.measurements[i], out.measurements[i]);
337 }
338 convertGnssClock(in.clock, out.clock);
339 }
340
convertGnssData_1_1(GnssMeasurementsNotification & in,V1_1::IGnssMeasurementCallback::GnssData & out)341 static void convertGnssData_1_1(GnssMeasurementsNotification& in,
342 V1_1::IGnssMeasurementCallback::GnssData& out)
343 {
344 memset(&out, 0, sizeof(out));
345 out.measurements.resize(in.count);
346 for (size_t i = 0; i < in.count; i++) {
347 convertGnssMeasurement(in.measurements[i], out.measurements[i].v1_0);
348 if (in.measurements[i].adrStateMask & GNSS_MEASUREMENTS_ACCUMULATED_DELTA_RANGE_STATE_VALID_BIT)
349 out.measurements[i].accumulatedDeltaRangeState |=
350 IGnssMeasurementCallback::GnssAccumulatedDeltaRangeState::ADR_STATE_VALID;
351 if (in.measurements[i].adrStateMask & GNSS_MEASUREMENTS_ACCUMULATED_DELTA_RANGE_STATE_RESET_BIT)
352 out.measurements[i].accumulatedDeltaRangeState |=
353 IGnssMeasurementCallback::GnssAccumulatedDeltaRangeState::ADR_STATE_RESET;
354 if (in.measurements[i].adrStateMask & GNSS_MEASUREMENTS_ACCUMULATED_DELTA_RANGE_STATE_CYCLE_SLIP_BIT)
355 out.measurements[i].accumulatedDeltaRangeState |=
356 IGnssMeasurementCallback::GnssAccumulatedDeltaRangeState::ADR_STATE_CYCLE_SLIP;
357 if (in.measurements[i].adrStateMask & GNSS_MEASUREMENTS_ACCUMULATED_DELTA_RANGE_STATE_HALF_CYCLE_RESOLVED_BIT)
358 out.measurements[i].accumulatedDeltaRangeState |=
359 IGnssMeasurementCallback::GnssAccumulatedDeltaRangeState::ADR_STATE_HALF_CYCLE_RESOLVED;
360 }
361 convertGnssClock(in.clock, out.clock);
362 }
363
convertGnssData_2_0(GnssMeasurementsNotification & in,V2_0::IGnssMeasurementCallback::GnssData & out)364 static void convertGnssData_2_0(GnssMeasurementsNotification& in,
365 V2_0::IGnssMeasurementCallback::GnssData& out)
366 {
367 memset(&out, 0, sizeof(out));
368 out.measurements.resize(in.count);
369 for (size_t i = 0; i < in.count; i++) {
370 convertGnssMeasurement(in.measurements[i], out.measurements[i].v1_1.v1_0);
371 convertGnssConstellationType(in.measurements[i].svType, out.measurements[i].constellation);
372 convertGnssMeasurementsCodeType(in.measurements[i].codeType, out.measurements[i].codeType);
373 if (in.measurements[i].adrStateMask & GNSS_MEASUREMENTS_ACCUMULATED_DELTA_RANGE_STATE_VALID_BIT)
374 out.measurements[i].v1_1.accumulatedDeltaRangeState |=
375 IGnssMeasurementCallback::GnssAccumulatedDeltaRangeState::ADR_STATE_VALID;
376 if (in.measurements[i].adrStateMask & GNSS_MEASUREMENTS_ACCUMULATED_DELTA_RANGE_STATE_RESET_BIT)
377 out.measurements[i].v1_1.accumulatedDeltaRangeState |=
378 IGnssMeasurementCallback::GnssAccumulatedDeltaRangeState::ADR_STATE_RESET;
379 if (in.measurements[i].adrStateMask & GNSS_MEASUREMENTS_ACCUMULATED_DELTA_RANGE_STATE_CYCLE_SLIP_BIT)
380 out.measurements[i].v1_1.accumulatedDeltaRangeState |=
381 IGnssMeasurementCallback::GnssAccumulatedDeltaRangeState::ADR_STATE_CYCLE_SLIP;
382 if (in.measurements[i].adrStateMask & GNSS_MEASUREMENTS_ACCUMULATED_DELTA_RANGE_STATE_HALF_CYCLE_RESOLVED_BIT)
383 out.measurements[i].v1_1.accumulatedDeltaRangeState |=
384 IGnssMeasurementCallback::GnssAccumulatedDeltaRangeState::ADR_STATE_HALF_CYCLE_RESOLVED;
385 if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_CODE_LOCK_BIT)
386 out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_CODE_LOCK;
387 if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_BIT_SYNC_BIT)
388 out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_BIT_SYNC;
389 if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_SUBFRAME_SYNC_BIT)
390 out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_SUBFRAME_SYNC;
391 if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_TOW_DECODED_BIT)
392 out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_TOW_DECODED;
393 if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_MSEC_AMBIGUOUS_BIT)
394 out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_MSEC_AMBIGUOUS;
395 if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_SYMBOL_SYNC_BIT)
396 out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_SYMBOL_SYNC;
397 if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_GLO_STRING_SYNC_BIT)
398 out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_GLO_STRING_SYNC;
399 if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_GLO_TOD_DECODED_BIT)
400 out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_GLO_TOD_DECODED;
401 if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_BDS_D2_BIT_SYNC_BIT)
402 out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_BDS_D2_BIT_SYNC;
403 if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_BDS_D2_SUBFRAME_SYNC_BIT)
404 out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_BDS_D2_SUBFRAME_SYNC;
405 if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_GAL_E1BC_CODE_LOCK_BIT)
406 out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_GAL_E1BC_CODE_LOCK;
407 if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_GAL_E1C_2ND_CODE_LOCK_BIT)
408 out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_GAL_E1C_2ND_CODE_LOCK;
409 if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_GAL_E1B_PAGE_SYNC_BIT)
410 out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_GAL_E1B_PAGE_SYNC;
411 if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_SBAS_SYNC_BIT)
412 out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_SBAS_SYNC;
413 if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_TOW_KNOWN_BIT)
414 out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_TOW_KNOWN;
415 if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_GLO_TOD_KNOWN_BIT)
416 out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_GLO_TOD_KNOWN;
417 if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_2ND_CODE_LOCK_BIT)
418 out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_2ND_CODE_LOCK;
419 }
420 convertGnssClock(in.clock, out.clock);
421
422 const uint32_t UTC_TO_GPS_SECONDS = 315964800;
423 struct timespec currentTime;
424 int64_t sinceBootTimeNanos;
425
426 if (getCurrentTime(currentTime, sinceBootTimeNanos) &&
427 in.clock.flags & GNSS_MEASUREMENTS_CLOCK_FLAGS_LEAP_SECOND_BIT &&
428 in.clock.flags & GNSS_MEASUREMENTS_CLOCK_FLAGS_FULL_BIAS_BIT &&
429 in.clock.flags & GNSS_MEASUREMENTS_CLOCK_FLAGS_BIAS_BIT &&
430 in.clock.flags & GNSS_MEASUREMENTS_CLOCK_FLAGS_BIAS_UNCERTAINTY_BIT) {
431 int64_t currentTimeNanos = currentTime.tv_sec * 1000000000 + currentTime.tv_nsec;
432 int64_t measTimeNanos = (int64_t)in.clock.timeNs - (int64_t)in.clock.fullBiasNs
433 - (int64_t)in.clock.biasNs - (int64_t)in.clock.leapSecond * 1000000000
434 + (int64_t)UTC_TO_GPS_SECONDS * 1000000000;
435
436 LOC_LOGd("sinceBootTimeNanos:%" PRIi64 " currentTimeNanos:%" PRIi64 ""
437 " measTimeNanos:%" PRIi64 "",
438 sinceBootTimeNanos, currentTimeNanos, measTimeNanos);
439 if (currentTimeNanos >= measTimeNanos) {
440 int64_t ageTimeNanos = currentTimeNanos - measTimeNanos;
441 LOC_LOGD("%s]: ageTimeNanos:%" PRIi64 ")", __FUNCTION__, ageTimeNanos);
442 // the max trusted propagation time 30s for ageTimeNanos to avoid user setting
443 //wrong time, it will affect elapsedRealtimeNanos
444 if (ageTimeNanos >= 0 && ageTimeNanos <= 30000000000) {
445 out.elapsedRealtime.flags |= ElapsedRealtimeFlags::HAS_TIMESTAMP_NS;
446 out.elapsedRealtime.timestampNs = sinceBootTimeNanos - ageTimeNanos;
447 out.elapsedRealtime.flags |= ElapsedRealtimeFlags::HAS_TIME_UNCERTAINTY_NS;
448 // time uncertainty is the max value between abs(AP_UTC - MP_UTC) and 100ms, to
449 //verify if user change the sys time
450 out.elapsedRealtime.timeUncertaintyNs =
451 std::max((int64_t)abs(currentTimeNanos - measTimeNanos),
452 (int64_t)100000000);
453 LOC_LOGd("timestampNs:%" PRIi64 ") timeUncertaintyNs:%" PRIi64 ")",
454 out.elapsedRealtime.timestampNs,
455 out.elapsedRealtime.timeUncertaintyNs);
456 }
457 }
458 } else {
459 LOC_LOGe("Failed to calculate elapsedRealtimeNanos timestamp");
460 }
461 }
462
convertGnssMeasurementsCodeType(GnssMeasurementsCodeType & in,::android::hardware::hidl_string & out)463 static void convertGnssMeasurementsCodeType(GnssMeasurementsCodeType& in,
464 ::android::hardware::hidl_string& out)
465 {
466 switch(in) {
467 case GNSS_MEASUREMENTS_CODE_TYPE_A:
468 out = "A";
469 break;
470 case GNSS_MEASUREMENTS_CODE_TYPE_B:
471 out = "B";
472 break;
473 case GNSS_MEASUREMENTS_CODE_TYPE_C:
474 out = "C";
475 break;
476 case GNSS_MEASUREMENTS_CODE_TYPE_I:
477 out = "I";
478 break;
479 case GNSS_MEASUREMENTS_CODE_TYPE_L:
480 out = "L";
481 break;
482 case GNSS_MEASUREMENTS_CODE_TYPE_M:
483 out = "M";
484 break;
485 case GNSS_MEASUREMENTS_CODE_TYPE_P:
486 out = "P";
487 break;
488 case GNSS_MEASUREMENTS_CODE_TYPE_Q:
489 out = "Q";
490 break;
491 case GNSS_MEASUREMENTS_CODE_TYPE_S:
492 out = "S";
493 break;
494 case GNSS_MEASUREMENTS_CODE_TYPE_W:
495 out = "W";
496 break;
497 case GNSS_MEASUREMENTS_CODE_TYPE_X:
498 out = "X";
499 break;
500 case GNSS_MEASUREMENTS_CODE_TYPE_Y:
501 out = "Y";
502 break;
503 case GNSS_MEASUREMENTS_CODE_TYPE_Z:
504 out = "Z";
505 break;
506 case GNSS_MEASUREMENTS_CODE_TYPE_N:
507 out = "N";
508 break;
509 default:
510 out = "UNKNOWN";
511 }
512 }
513
514 } // namespace implementation
515 } // namespace V2_0
516 } // namespace gnss
517 } // namespace hardware
518 } // namespace android
519