1 /* Copyright (c) 2017, 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_NDDEBUG 0
31 #define LOG_TAG "LocSvc_MeasurementAPIClient"
32 
33 #include <log_util.h>
34 #include <loc_cfg.h>
35 
36 #include "LocationUtil.h"
37 #include "MeasurementAPIClient.h"
38 
39 namespace android {
40 namespace hardware {
41 namespace gnss {
42 namespace V1_0 {
43 namespace implementation {
44 
45 static void convertGnssData(GnssMeasurementsNotification& in,
46         IGnssMeasurementCallback::GnssData& out);
47 static void convertGnssMeasurement(GnssMeasurementsData& in,
48         IGnssMeasurementCallback::GnssMeasurement& out);
49 static void convertGnssClock(GnssMeasurementsClock& in, IGnssMeasurementCallback::GnssClock& out);
50 
MeasurementAPIClient()51 MeasurementAPIClient::MeasurementAPIClient() :
52     mGnssMeasurementCbIface(nullptr),
53     mTracking(false)
54 {
55     LOC_LOGD("%s]: ()", __FUNCTION__);
56 }
57 
~MeasurementAPIClient()58 MeasurementAPIClient::~MeasurementAPIClient()
59 {
60     LOC_LOGD("%s]: ()", __FUNCTION__);
61 }
62 
63 // for GpsInterface
64 Return<IGnssMeasurement::GnssMeasurementStatus>
measurementSetCallback(const sp<IGnssMeasurementCallback> & callback)65 MeasurementAPIClient::measurementSetCallback(const sp<IGnssMeasurementCallback>& callback)
66 {
67     LOC_LOGD("%s]: (%p)", __FUNCTION__, &callback);
68 
69     mGnssMeasurementCbIface = callback;
70 
71     LocationCallbacks locationCallbacks;
72     locationCallbacks.size = sizeof(LocationCallbacks);
73 
74     locationCallbacks.trackingCb = nullptr;
75     locationCallbacks.batchingCb = nullptr;
76     locationCallbacks.geofenceBreachCb = nullptr;
77     locationCallbacks.geofenceStatusCb = nullptr;
78     locationCallbacks.gnssLocationInfoCb = nullptr;
79     locationCallbacks.gnssNiCb = nullptr;
80     locationCallbacks.gnssSvCb = nullptr;
81     locationCallbacks.gnssNmeaCb = nullptr;
82 
83     locationCallbacks.gnssMeasurementsCb = nullptr;
84     if (mGnssMeasurementCbIface != nullptr) {
85         locationCallbacks.gnssMeasurementsCb =
86             [this](GnssMeasurementsNotification gnssMeasurementsNotification) {
87                 onGnssMeasurementsCb(gnssMeasurementsNotification);
88             };
89     }
90 
91     locAPISetCallbacks(locationCallbacks);
92     LocationOptions options;
93     memset(&options, 0, sizeof(LocationOptions));
94     options.size = sizeof(LocationOptions);
95     options.minInterval = 1000;
96     options.mode = GNSS_SUPL_MODE_STANDALONE;
97     mTracking = true;
98     LOC_LOGD("%s]: start tracking session", __FUNCTION__);
99     locAPIStartTracking(options);
100 
101     return IGnssMeasurement::GnssMeasurementStatus::SUCCESS;
102 }
103 
104 // for GpsMeasurementInterface
measurementClose()105 void MeasurementAPIClient::measurementClose() {
106     LOC_LOGD("%s]: ()", __FUNCTION__);
107     mTracking = false;
108     locAPIStopTracking();
109 }
110 
111 // callbacks
onGnssMeasurementsCb(GnssMeasurementsNotification gnssMeasurementsNotification)112 void MeasurementAPIClient::onGnssMeasurementsCb(
113         GnssMeasurementsNotification gnssMeasurementsNotification)
114 {
115     LOC_LOGD("%s]: (count: %zu active: %zu)",
116          __FUNCTION__, gnssMeasurementsNotification.count, mTracking);
117     if (mTracking) {
118         if (mGnssMeasurementCbIface != nullptr) {
119             IGnssMeasurementCallback::GnssData gnssData;
120             convertGnssData(gnssMeasurementsNotification, gnssData);
121             auto r = mGnssMeasurementCbIface->GnssMeasurementCb(gnssData);
122             if (!r.isOk()) {
123                 LOC_LOGE("%s] Error from GnssMeasurementCb description=%s",
124                     __func__, r.description().c_str());
125             }
126         }
127     }
128 }
129 
convertGnssMeasurement(GnssMeasurementsData & in,IGnssMeasurementCallback::GnssMeasurement & out)130 static void convertGnssMeasurement(GnssMeasurementsData& in,
131         IGnssMeasurementCallback::GnssMeasurement& out)
132 {
133     memset(&out, 0, sizeof(IGnssMeasurementCallback::GnssMeasurement));
134     if (in.flags & GNSS_MEASUREMENTS_DATA_SIGNAL_TO_NOISE_RATIO_BIT)
135         out.flags |= IGnssMeasurementCallback::GnssMeasurementFlags::HAS_SNR;
136     if (in.flags & GNSS_MEASUREMENTS_DATA_CARRIER_FREQUENCY_BIT)
137         out.flags |= IGnssMeasurementCallback::GnssMeasurementFlags::HAS_CARRIER_FREQUENCY;
138     if (in.flags & GNSS_MEASUREMENTS_DATA_CARRIER_CYCLES_BIT)
139         out.flags |= IGnssMeasurementCallback::GnssMeasurementFlags::HAS_CARRIER_CYCLES;
140     if (in.flags & GNSS_MEASUREMENTS_DATA_CARRIER_PHASE_BIT)
141         out.flags |= IGnssMeasurementCallback::GnssMeasurementFlags::HAS_CARRIER_PHASE;
142     if (in.flags & GNSS_MEASUREMENTS_DATA_CARRIER_PHASE_UNCERTAINTY_BIT)
143         out.flags |= IGnssMeasurementCallback::GnssMeasurementFlags::HAS_CARRIER_PHASE_UNCERTAINTY;
144     if (in.flags & GNSS_MEASUREMENTS_DATA_AUTOMATIC_GAIN_CONTROL_BIT)
145         out.flags |= IGnssMeasurementCallback::GnssMeasurementFlags::HAS_AUTOMATIC_GAIN_CONTROL;
146     out.svid = in.svId;
147     convertGnssConstellationType(in.svType, out.constellation);
148     out.timeOffsetNs = in.timeOffsetNs;
149     if (in.stateMask & GNSS_MEASUREMENTS_STATE_CODE_LOCK_BIT)
150         out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_CODE_LOCK;
151     if (in.stateMask & GNSS_MEASUREMENTS_STATE_BIT_SYNC_BIT)
152         out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_BIT_SYNC;
153     if (in.stateMask & GNSS_MEASUREMENTS_STATE_SUBFRAME_SYNC_BIT)
154         out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_SUBFRAME_SYNC;
155     if (in.stateMask & GNSS_MEASUREMENTS_STATE_TOW_DECODED_BIT)
156         out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_TOW_DECODED;
157     if (in.stateMask & GNSS_MEASUREMENTS_STATE_MSEC_AMBIGUOUS_BIT)
158         out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_MSEC_AMBIGUOUS;
159     if (in.stateMask & GNSS_MEASUREMENTS_STATE_SYMBOL_SYNC_BIT)
160         out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_SYMBOL_SYNC;
161     if (in.stateMask & GNSS_MEASUREMENTS_STATE_GLO_STRING_SYNC_BIT)
162         out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_GLO_STRING_SYNC;
163     if (in.stateMask & GNSS_MEASUREMENTS_STATE_GLO_TOD_DECODED_BIT)
164         out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_GLO_TOD_DECODED;
165     if (in.stateMask & GNSS_MEASUREMENTS_STATE_BDS_D2_BIT_SYNC_BIT)
166         out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_BDS_D2_BIT_SYNC;
167     if (in.stateMask & GNSS_MEASUREMENTS_STATE_BDS_D2_SUBFRAME_SYNC_BIT)
168         out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_BDS_D2_SUBFRAME_SYNC;
169     if (in.stateMask & GNSS_MEASUREMENTS_STATE_GAL_E1BC_CODE_LOCK_BIT)
170         out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_GAL_E1BC_CODE_LOCK;
171     if (in.stateMask & GNSS_MEASUREMENTS_STATE_GAL_E1C_2ND_CODE_LOCK_BIT)
172         out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_GAL_E1C_2ND_CODE_LOCK;
173     if (in.stateMask & GNSS_MEASUREMENTS_STATE_GAL_E1B_PAGE_SYNC_BIT)
174         out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_GAL_E1B_PAGE_SYNC;
175     if (in.stateMask &  GNSS_MEASUREMENTS_STATE_SBAS_SYNC_BIT)
176         out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_SBAS_SYNC;
177     out.receivedSvTimeInNs = in.receivedSvTimeNs;
178     out.receivedSvTimeUncertaintyInNs = in.receivedSvTimeUncertaintyNs;
179     out.cN0DbHz = in.carrierToNoiseDbHz;
180     out.pseudorangeRateMps = in.pseudorangeRateMps;
181     out.pseudorangeRateUncertaintyMps = in.pseudorangeRateUncertaintyMps;
182     if (in.adrStateMask & GNSS_MEASUREMENTS_ACCUMULATED_DELTA_RANGE_STATE_VALID_BIT)
183         out.accumulatedDeltaRangeState |=
184             IGnssMeasurementCallback::GnssAccumulatedDeltaRangeState::ADR_STATE_VALID;
185     if (in.adrStateMask & GNSS_MEASUREMENTS_ACCUMULATED_DELTA_RANGE_STATE_RESET_BIT)
186         out.accumulatedDeltaRangeState |=
187             IGnssMeasurementCallback::GnssAccumulatedDeltaRangeState::ADR_STATE_RESET;
188     if (in.adrStateMask & GNSS_MEASUREMENTS_ACCUMULATED_DELTA_RANGE_STATE_CYCLE_SLIP_BIT)
189         out.accumulatedDeltaRangeState |=
190             IGnssMeasurementCallback::GnssAccumulatedDeltaRangeState::ADR_STATE_CYCLE_SLIP;
191     out.accumulatedDeltaRangeM = in.adrMeters;
192     out.accumulatedDeltaRangeUncertaintyM = in.adrUncertaintyMeters;
193     out.carrierFrequencyHz = in.carrierFrequencyHz;
194     out.carrierCycles = in.carrierCycles;
195     out.carrierPhase = in.carrierPhase;
196     out.carrierPhaseUncertainty = in.carrierPhaseUncertainty;
197     uint8_t indicator =
198         static_cast<uint8_t>(IGnssMeasurementCallback::GnssMultipathIndicator::INDICATOR_UNKNOWN);
199     if (in.multipathIndicator & GNSS_MEASUREMENTS_MULTIPATH_INDICATOR_PRESENT)
200         indicator |= IGnssMeasurementCallback::GnssMultipathIndicator::INDICATOR_PRESENT;
201     if (in.multipathIndicator & GNSS_MEASUREMENTS_MULTIPATH_INDICATOR_NOT_PRESENT)
202         indicator |= IGnssMeasurementCallback::GnssMultipathIndicator::INDICATIOR_NOT_PRESENT;
203     out.multipathIndicator =
204         static_cast<IGnssMeasurementCallback::GnssMultipathIndicator>(indicator);
205     out.snrDb = in.signalToNoiseRatioDb;
206     out.agcLevelDb = in.agcLevelDb;
207 }
208 
convertGnssClock(GnssMeasurementsClock & in,IGnssMeasurementCallback::GnssClock & out)209 static void convertGnssClock(GnssMeasurementsClock& in, IGnssMeasurementCallback::GnssClock& out)
210 {
211     memset(&out, 0, sizeof(IGnssMeasurementCallback::GnssClock));
212     if (in.flags & GNSS_MEASUREMENTS_CLOCK_FLAGS_LEAP_SECOND_BIT)
213         out.gnssClockFlags |= IGnssMeasurementCallback::GnssClockFlags::HAS_LEAP_SECOND;
214     if (in.flags & GNSS_MEASUREMENTS_CLOCK_FLAGS_TIME_UNCERTAINTY_BIT)
215         out.gnssClockFlags |= IGnssMeasurementCallback::GnssClockFlags::HAS_TIME_UNCERTAINTY;
216     if (in.flags & GNSS_MEASUREMENTS_CLOCK_FLAGS_FULL_BIAS_BIT)
217         out.gnssClockFlags |= IGnssMeasurementCallback::GnssClockFlags::HAS_FULL_BIAS;
218     if (in.flags & GNSS_MEASUREMENTS_CLOCK_FLAGS_BIAS_BIT)
219         out.gnssClockFlags |= IGnssMeasurementCallback::GnssClockFlags::HAS_BIAS;
220     if (in.flags & GNSS_MEASUREMENTS_CLOCK_FLAGS_BIAS_UNCERTAINTY_BIT)
221         out.gnssClockFlags |= IGnssMeasurementCallback::GnssClockFlags::HAS_BIAS_UNCERTAINTY;
222     if (in.flags & GNSS_MEASUREMENTS_CLOCK_FLAGS_DRIFT_BIT)
223         out.gnssClockFlags |= IGnssMeasurementCallback::GnssClockFlags::HAS_DRIFT;
224     if (in.flags & GNSS_MEASUREMENTS_CLOCK_FLAGS_DRIFT_UNCERTAINTY_BIT)
225         out.gnssClockFlags |= IGnssMeasurementCallback::GnssClockFlags::HAS_DRIFT_UNCERTAINTY;
226     out.leapSecond = in.leapSecond;
227     out.timeNs = in.timeNs;
228     out.timeUncertaintyNs = in.timeUncertaintyNs;
229     out.fullBiasNs = in.fullBiasNs;
230     out.biasNs = in.biasNs;
231     out.biasUncertaintyNs = in.biasUncertaintyNs;
232     out.driftNsps = in.driftNsps;
233     out.driftUncertaintyNsps = in.driftUncertaintyNsps;
234     out.hwClockDiscontinuityCount = in.hwClockDiscontinuityCount;
235 }
236 
convertGnssData(GnssMeasurementsNotification & in,IGnssMeasurementCallback::GnssData & out)237 static void convertGnssData(GnssMeasurementsNotification& in,
238         IGnssMeasurementCallback::GnssData& out)
239 {
240     out.measurementCount = in.count;
241     if (out.measurementCount > static_cast<uint32_t>(GnssMax::SVS_COUNT)) {
242         LOC_LOGW("%s]: Too many measurement %zd. Clamps to %d.",
243                 __FUNCTION__,  out.measurementCount, GnssMax::SVS_COUNT);
244         out.measurementCount = static_cast<uint32_t>(GnssMax::SVS_COUNT);
245     }
246     for (size_t i = 0; i < out.measurementCount; i++) {
247         convertGnssMeasurement(in.measurements[i], out.measurements[i]);
248     }
249     convertGnssClock(in.clock, out.clock);
250 }
251 
252 }  // namespace implementation
253 }  // namespace V1_0
254 }  // namespace gnss
255 }  // namespace hardware
256 }  // namespace android
257