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(IGnssMeasurementCallback::GnssClock));
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     out.measurementCount = in.count;
329     if (out.measurementCount > static_cast<uint32_t>(V1_0::GnssMax::SVS_COUNT)) {
330         LOC_LOGW("%s]: Too many measurement %u. Clamps to %d.",
331                 __FUNCTION__,  out.measurementCount, V1_0::GnssMax::SVS_COUNT);
332         out.measurementCount = static_cast<uint32_t>(V1_0::GnssMax::SVS_COUNT);
333     }
334     for (size_t i = 0; i < out.measurementCount; i++) {
335         convertGnssMeasurement(in.measurements[i], out.measurements[i]);
336     }
337     convertGnssClock(in.clock, out.clock);
338 }
339 
convertGnssData_1_1(GnssMeasurementsNotification & in,V1_1::IGnssMeasurementCallback::GnssData & out)340 static void convertGnssData_1_1(GnssMeasurementsNotification& in,
341         V1_1::IGnssMeasurementCallback::GnssData& out)
342 {
343     out.measurements.resize(in.count);
344     for (size_t i = 0; i < in.count; i++) {
345         convertGnssMeasurement(in.measurements[i], out.measurements[i].v1_0);
346         if (in.measurements[i].adrStateMask & GNSS_MEASUREMENTS_ACCUMULATED_DELTA_RANGE_STATE_VALID_BIT)
347             out.measurements[i].accumulatedDeltaRangeState |=
348             IGnssMeasurementCallback::GnssAccumulatedDeltaRangeState::ADR_STATE_VALID;
349         if (in.measurements[i].adrStateMask & GNSS_MEASUREMENTS_ACCUMULATED_DELTA_RANGE_STATE_RESET_BIT)
350             out.measurements[i].accumulatedDeltaRangeState |=
351             IGnssMeasurementCallback::GnssAccumulatedDeltaRangeState::ADR_STATE_RESET;
352         if (in.measurements[i].adrStateMask & GNSS_MEASUREMENTS_ACCUMULATED_DELTA_RANGE_STATE_CYCLE_SLIP_BIT)
353             out.measurements[i].accumulatedDeltaRangeState |=
354             IGnssMeasurementCallback::GnssAccumulatedDeltaRangeState::ADR_STATE_CYCLE_SLIP;
355         if (in.measurements[i].adrStateMask & GNSS_MEASUREMENTS_ACCUMULATED_DELTA_RANGE_STATE_HALF_CYCLE_RESOLVED_BIT)
356             out.measurements[i].accumulatedDeltaRangeState |=
357             IGnssMeasurementCallback::GnssAccumulatedDeltaRangeState::ADR_STATE_HALF_CYCLE_RESOLVED;
358     }
359     convertGnssClock(in.clock, out.clock);
360 }
361 
convertGnssData_2_0(GnssMeasurementsNotification & in,V2_0::IGnssMeasurementCallback::GnssData & out)362 static void convertGnssData_2_0(GnssMeasurementsNotification& in,
363         V2_0::IGnssMeasurementCallback::GnssData& out)
364 {
365     memset(&out, 0, sizeof(V2_0::IGnssMeasurementCallback::GnssData));
366     out.measurements.resize(in.count);
367     for (size_t i = 0; i < in.count; i++) {
368         convertGnssMeasurement(in.measurements[i], out.measurements[i].v1_1.v1_0);
369         convertGnssConstellationType(in.measurements[i].svType, out.measurements[i].constellation);
370         convertGnssMeasurementsCodeType(in.measurements[i].codeType, out.measurements[i].codeType);
371         if (in.measurements[i].adrStateMask & GNSS_MEASUREMENTS_ACCUMULATED_DELTA_RANGE_STATE_VALID_BIT)
372             out.measurements[i].v1_1.accumulatedDeltaRangeState |=
373             IGnssMeasurementCallback::GnssAccumulatedDeltaRangeState::ADR_STATE_VALID;
374         if (in.measurements[i].adrStateMask & GNSS_MEASUREMENTS_ACCUMULATED_DELTA_RANGE_STATE_RESET_BIT)
375             out.measurements[i].v1_1.accumulatedDeltaRangeState |=
376             IGnssMeasurementCallback::GnssAccumulatedDeltaRangeState::ADR_STATE_RESET;
377         if (in.measurements[i].adrStateMask & GNSS_MEASUREMENTS_ACCUMULATED_DELTA_RANGE_STATE_CYCLE_SLIP_BIT)
378             out.measurements[i].v1_1.accumulatedDeltaRangeState |=
379             IGnssMeasurementCallback::GnssAccumulatedDeltaRangeState::ADR_STATE_CYCLE_SLIP;
380         if (in.measurements[i].adrStateMask & GNSS_MEASUREMENTS_ACCUMULATED_DELTA_RANGE_STATE_HALF_CYCLE_RESOLVED_BIT)
381             out.measurements[i].v1_1.accumulatedDeltaRangeState |=
382             IGnssMeasurementCallback::GnssAccumulatedDeltaRangeState::ADR_STATE_HALF_CYCLE_RESOLVED;
383         if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_CODE_LOCK_BIT)
384             out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_CODE_LOCK;
385         if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_BIT_SYNC_BIT)
386             out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_BIT_SYNC;
387         if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_SUBFRAME_SYNC_BIT)
388             out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_SUBFRAME_SYNC;
389         if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_TOW_DECODED_BIT)
390             out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_TOW_DECODED;
391         if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_MSEC_AMBIGUOUS_BIT)
392             out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_MSEC_AMBIGUOUS;
393         if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_SYMBOL_SYNC_BIT)
394             out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_SYMBOL_SYNC;
395         if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_GLO_STRING_SYNC_BIT)
396             out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_GLO_STRING_SYNC;
397         if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_GLO_TOD_DECODED_BIT)
398             out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_GLO_TOD_DECODED;
399         if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_BDS_D2_BIT_SYNC_BIT)
400             out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_BDS_D2_BIT_SYNC;
401         if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_BDS_D2_SUBFRAME_SYNC_BIT)
402             out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_BDS_D2_SUBFRAME_SYNC;
403         if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_GAL_E1BC_CODE_LOCK_BIT)
404             out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_GAL_E1BC_CODE_LOCK;
405         if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_GAL_E1C_2ND_CODE_LOCK_BIT)
406             out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_GAL_E1C_2ND_CODE_LOCK;
407         if (in.measurements[i].stateMask & GNSS_MEASUREMENTS_STATE_GAL_E1B_PAGE_SYNC_BIT)
408             out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_GAL_E1B_PAGE_SYNC;
409         if (in.measurements[i].stateMask &  GNSS_MEASUREMENTS_STATE_SBAS_SYNC_BIT)
410             out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_SBAS_SYNC;
411         if (in.measurements[i].stateMask &  GNSS_MEASUREMENTS_STATE_TOW_KNOWN_BIT)
412             out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_TOW_KNOWN;
413         if (in.measurements[i].stateMask &  GNSS_MEASUREMENTS_STATE_GLO_TOD_KNOWN_BIT)
414             out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_GLO_TOD_KNOWN;
415         if (in.measurements[i].stateMask &  GNSS_MEASUREMENTS_STATE_2ND_CODE_LOCK_BIT)
416             out.measurements[i].state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_2ND_CODE_LOCK;
417     }
418     convertGnssClock(in.clock, out.clock);
419 
420     const uint32_t UTC_TO_GPS_SECONDS = 315964800;
421     struct timespec currentTime;
422     int64_t sinceBootTimeNanos;
423 
424     if (getCurrentTime(currentTime, sinceBootTimeNanos) &&
425         in.clock.flags & GNSS_MEASUREMENTS_CLOCK_FLAGS_LEAP_SECOND_BIT &&
426         in.clock.flags & GNSS_MEASUREMENTS_CLOCK_FLAGS_FULL_BIAS_BIT &&
427         in.clock.flags & GNSS_MEASUREMENTS_CLOCK_FLAGS_BIAS_BIT &&
428         in.clock.flags & GNSS_MEASUREMENTS_CLOCK_FLAGS_BIAS_UNCERTAINTY_BIT) {
429         int64_t currentTimeNanos = currentTime.tv_sec * 1000000000 + currentTime.tv_nsec;
430         int64_t measTimeNanos = (int64_t)in.clock.timeNs - (int64_t)in.clock.fullBiasNs
431                 - (int64_t)in.clock.biasNs - (int64_t)in.clock.leapSecond * 1000000000
432                 + (int64_t)UTC_TO_GPS_SECONDS * 1000000000;
433 
434         LOC_LOGd("sinceBootTimeNanos:%" PRIi64 " currentTimeNanos:%" PRIi64 ""
435                  " measTimeNanos:%" PRIi64 "",
436                  sinceBootTimeNanos, currentTimeNanos, measTimeNanos);
437         if (currentTimeNanos >= measTimeNanos) {
438             int64_t ageTimeNanos = currentTimeNanos - measTimeNanos;
439             LOC_LOGD("%s]: ageTimeNanos:%" PRIi64 ")", __FUNCTION__, ageTimeNanos);
440             if (ageTimeNanos >= 0 && ageTimeNanos <= sinceBootTimeNanos) {
441                 out.elapsedRealtime.flags |= ElapsedRealtimeFlags::HAS_TIMESTAMP_NS;
442                 out.elapsedRealtime.timestampNs = sinceBootTimeNanos - ageTimeNanos;
443                 out.elapsedRealtime.flags |= ElapsedRealtimeFlags::HAS_TIME_UNCERTAINTY_NS;
444                 // time uncertainty is 1 ms since it is calculated from utc time that is in ms
445                 out.elapsedRealtime.timeUncertaintyNs = 1000000;
446                 LOC_LOGd("timestampNs:%" PRIi64 ") timeUncertaintyNs:%" PRIi64 ")",
447                          out.elapsedRealtime.timestampNs,
448                          out.elapsedRealtime.timeUncertaintyNs);
449             }
450         }
451     } else {
452         LOC_LOGe("Failed to calculate elapsedRealtimeNanos timestamp");
453     }
454 }
455 
convertGnssMeasurementsCodeType(GnssMeasurementsCodeType & in,::android::hardware::hidl_string & out)456 static void convertGnssMeasurementsCodeType(GnssMeasurementsCodeType& in,
457         ::android::hardware::hidl_string& out)
458 {
459     switch(in) {
460         case GNSS_MEASUREMENTS_CODE_TYPE_A:
461             out = "A";
462             break;
463         case GNSS_MEASUREMENTS_CODE_TYPE_B:
464             out = "B";
465             break;
466         case GNSS_MEASUREMENTS_CODE_TYPE_C:
467             out = "C";
468             break;
469         case GNSS_MEASUREMENTS_CODE_TYPE_I:
470             out = "I";
471             break;
472         case GNSS_MEASUREMENTS_CODE_TYPE_L:
473             out = "L";
474             break;
475         case GNSS_MEASUREMENTS_CODE_TYPE_M:
476             out = "M";
477             break;
478         case GNSS_MEASUREMENTS_CODE_TYPE_P:
479             out = "P";
480             break;
481         case GNSS_MEASUREMENTS_CODE_TYPE_Q:
482             out = "Q";
483             break;
484         case GNSS_MEASUREMENTS_CODE_TYPE_S:
485             out = "S";
486             break;
487         case GNSS_MEASUREMENTS_CODE_TYPE_W:
488             out = "W";
489             break;
490         case GNSS_MEASUREMENTS_CODE_TYPE_X:
491             out = "X";
492             break;
493         case GNSS_MEASUREMENTS_CODE_TYPE_Y:
494             out = "Y";
495             break;
496         case GNSS_MEASUREMENTS_CODE_TYPE_Z:
497             out = "Z";
498             break;
499         case GNSS_MEASUREMENTS_CODE_TYPE_N:
500             out = "N";
501             break;
502         default:
503             out = "UNKNOWN";
504     }
505 }
506 
507 }  // namespace implementation
508 }  // namespace V2_0
509 }  // namespace gnss
510 }  // namespace hardware
511 }  // namespace android
512