blob: 1ff84eb9a56b7d6ca8144f112932a53b9f3b88f4 [file] [log] [blame]
Yu-Han Yanga5098612019-02-08 16:22:07 -08001/*
2 * Copyright (C) 2019 The Android Open Source Project
3 *
4 * Licensed under the Apache License, Version 2.0 (the "License");
5 * you may not use this file except in compliance with the License.
6 * You may obtain a copy of the License at
7 *
8 * http://www.apache.org/licenses/LICENSE-2.0
9 *
10 * Unless required by applicable law or agreed to in writing, software
11 * distributed under the License is distributed on an "AS IS" BASIS,
12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13 * See the License for the specific language governing permissions and
14 * limitations under the License.
15 */
16
17#include <Constants.h>
Enrico Granata3ba5d222020-10-21 17:20:00 -060018#include <MockLocation.h>
Yu-Han Yanga5098612019-02-08 16:22:07 -080019#include <Utils.h>
Yu-Han Yang04832302020-11-20 09:51:18 -080020#include <aidl/android/hardware/gnss/BnGnss.h>
Yu-Han Yangc06b5362019-10-25 14:14:35 -070021#include <utils/SystemClock.h>
Yu-Han Yanga5098612019-02-08 16:22:07 -080022
23namespace android {
24namespace hardware {
25namespace gnss {
26namespace common {
27
Yu-Han Yangcfca8a72020-12-12 09:36:28 -080028using aidl::android::hardware::gnss::ElapsedRealtime;
29using aidl::android::hardware::gnss::GnssClock;
Yu-Han Yang1afbd5f2021-11-24 16:39:13 -080030using aidl::android::hardware::gnss::GnssConstellationType;
Yu-Han Yangcfca8a72020-12-12 09:36:28 -080031using aidl::android::hardware::gnss::GnssData;
Yu-Han Yang3a75dc02021-09-27 01:01:06 -070032using aidl::android::hardware::gnss::GnssLocation;
Yu-Han Yangcfca8a72020-12-12 09:36:28 -080033using aidl::android::hardware::gnss::GnssMeasurement;
34using aidl::android::hardware::gnss::IGnss;
35using aidl::android::hardware::gnss::IGnssMeasurementCallback;
Joe Huangf9853982021-05-08 13:27:29 +080036using aidl::android::hardware::gnss::SatellitePvt;
Yu-Han Yang1afbd5f2021-11-24 16:39:13 -080037using GnssSvInfo = aidl::android::hardware::gnss::IGnssCallback::GnssSvInfo;
38using GnssSvFlags = aidl::android::hardware::gnss::IGnssCallback::GnssSvFlags;
Yu-Han Yangcfca8a72020-12-12 09:36:28 -080039
Yu-Han Yang1afbd5f2021-11-24 16:39:13 -080040using GnssSvFlagsV1_0 = V1_0::IGnssCallback::GnssSvFlags;
Yu-Han Yang406cb762021-12-28 12:14:22 -080041using GnssAgc = aidl::android::hardware::gnss::GnssData::GnssAgc;
Yu-Han Yang5fe14fa2019-12-03 20:54:53 -080042using GnssMeasurementFlagsV1_0 = V1_0::IGnssMeasurementCallback::GnssMeasurementFlags;
43using GnssMeasurementFlagsV2_1 = V2_1::IGnssMeasurementCallback::GnssMeasurementFlags;
Yu-Han Yangc06b5362019-10-25 14:14:35 -070044using GnssMeasurementStateV2_0 = V2_0::IGnssMeasurementCallback::GnssMeasurementState;
Yu-Han Yangc06b5362019-10-25 14:14:35 -070045using ElapsedRealtimeFlags = V2_0::ElapsedRealtimeFlags;
46using GnssConstellationTypeV2_0 = V2_0::GnssConstellationType;
47using IGnssMeasurementCallbackV2_0 = V2_0::IGnssMeasurementCallback;
Yu-Han Yang5fe14fa2019-12-03 20:54:53 -080048using GnssSignalType = V2_1::GnssSignalType;
Yu-Han Yanga5098612019-02-08 16:22:07 -080049
Yu-Han Yang04832302020-11-20 09:51:18 -080050using GnssDataV2_0 = V2_0::IGnssMeasurementCallback::GnssData;
51using GnssDataV2_1 = V2_1::IGnssMeasurementCallback::GnssData;
52using GnssSvInfoV1_0 = V1_0::IGnssCallback::GnssSvInfo;
53using GnssSvInfoV2_0 = V2_0::IGnssCallback::GnssSvInfo;
54using GnssSvInfoV2_1 = V2_1::IGnssCallback::GnssSvInfo;
55using GnssAntennaInfo = ::android::hardware::gnss::V2_1::IGnssAntennaInfoCallback::GnssAntennaInfo;
56using Row = V2_1::IGnssAntennaInfoCallback::Row;
57using Coord = V2_1::IGnssAntennaInfoCallback::Coord;
58
Yu-Han Yangc06b5362019-10-25 14:14:35 -070059GnssDataV2_1 Utils::getMockMeasurementV2_1() {
60 GnssDataV2_0 gnssDataV2_0 = Utils::getMockMeasurementV2_0();
61 V2_1::IGnssMeasurementCallback::GnssMeasurement gnssMeasurementV2_1 = {
62 .v2_0 = gnssDataV2_0.measurements[0],
Yu-Han Yang5fe14fa2019-12-03 20:54:53 -080063 .flags = (uint32_t)(GnssMeasurementFlagsV2_1::HAS_CARRIER_FREQUENCY |
64 GnssMeasurementFlagsV2_1::HAS_CARRIER_PHASE |
Yu-Han Yang6668eab2020-03-03 15:23:50 -080065 GnssMeasurementFlagsV2_1::HAS_FULL_ISB |
66 GnssMeasurementFlagsV2_1::HAS_FULL_ISB_UNCERTAINTY |
Yu-Han Yang5fe14fa2019-12-03 20:54:53 -080067 GnssMeasurementFlagsV2_1::HAS_SATELLITE_ISB |
68 GnssMeasurementFlagsV2_1::HAS_SATELLITE_ISB_UNCERTAINTY),
Yu-Han Yang6668eab2020-03-03 15:23:50 -080069 .fullInterSignalBiasNs = 30.0,
70 .fullInterSignalBiasUncertaintyNs = 250.0,
Yu-Han Yang5fe14fa2019-12-03 20:54:53 -080071 .satelliteInterSignalBiasNs = 20.0,
72 .satelliteInterSignalBiasUncertaintyNs = 150.0,
Yu-Han Yangc06b5362019-10-25 14:14:35 -070073 .basebandCN0DbHz = 25.0,
74 };
Yu-Han Yang5fe14fa2019-12-03 20:54:53 -080075 GnssSignalType referenceSignalTypeForIsb = {
76 .constellation = GnssConstellationTypeV2_0::GPS,
77 .carrierFrequencyHz = 1.59975e+09,
78 .codeType = "C",
79 };
80 V2_1::IGnssMeasurementCallback::GnssClock gnssClockV2_1 = {
81 .v1_0 = gnssDataV2_0.clock,
82 .referenceSignalTypeForIsb = referenceSignalTypeForIsb,
83 };
Yu-Han Yangc06b5362019-10-25 14:14:35 -070084 hidl_vec<V2_1::IGnssMeasurementCallback::GnssMeasurement> measurements(1);
85 measurements[0] = gnssMeasurementV2_1;
86 GnssDataV2_1 gnssDataV2_1 = {
87 .measurements = measurements,
Yu-Han Yang5fe14fa2019-12-03 20:54:53 -080088 .clock = gnssClockV2_1,
Yu-Han Yangc06b5362019-10-25 14:14:35 -070089 .elapsedRealtime = gnssDataV2_0.elapsedRealtime,
90 };
91 return gnssDataV2_1;
92}
93
94GnssDataV2_0 Utils::getMockMeasurementV2_0() {
95 V1_0::IGnssMeasurementCallback::GnssMeasurement measurement_1_0 = {
Yu-Han Yang5fe14fa2019-12-03 20:54:53 -080096 .flags = (uint32_t)GnssMeasurementFlagsV1_0::HAS_CARRIER_FREQUENCY,
Yu-Han Yangc06b5362019-10-25 14:14:35 -070097 .svid = (int16_t)6,
98 .constellation = V1_0::GnssConstellationType::UNKNOWN,
99 .timeOffsetNs = 0.0,
100 .receivedSvTimeInNs = 8195997131077,
101 .receivedSvTimeUncertaintyInNs = 15,
102 .cN0DbHz = 30.0,
103 .pseudorangeRateMps = -484.13739013671875,
104 .pseudorangeRateUncertaintyMps = 1.0379999876022339,
105 .accumulatedDeltaRangeState = (uint32_t)V1_0::IGnssMeasurementCallback::
106 GnssAccumulatedDeltaRangeState::ADR_STATE_UNKNOWN,
107 .accumulatedDeltaRangeM = 0.0,
108 .accumulatedDeltaRangeUncertaintyM = 0.0,
109 .carrierFrequencyHz = 1.59975e+09,
110 .multipathIndicator =
111 V1_0::IGnssMeasurementCallback::GnssMultipathIndicator::INDICATOR_UNKNOWN};
112 V1_1::IGnssMeasurementCallback::GnssMeasurement measurement_1_1 = {.v1_0 = measurement_1_0};
113 V2_0::IGnssMeasurementCallback::GnssMeasurement measurement_2_0 = {
114 .v1_1 = measurement_1_1,
115 .codeType = "C",
116 .state = GnssMeasurementStateV2_0::STATE_CODE_LOCK |
117 GnssMeasurementStateV2_0::STATE_BIT_SYNC |
118 GnssMeasurementStateV2_0::STATE_SUBFRAME_SYNC |
119 GnssMeasurementStateV2_0::STATE_TOW_DECODED |
120 GnssMeasurementStateV2_0::STATE_GLO_STRING_SYNC |
121 GnssMeasurementStateV2_0::STATE_GLO_TOD_DECODED,
122 .constellation = GnssConstellationTypeV2_0::GLONASS,
123 };
124
125 hidl_vec<IGnssMeasurementCallbackV2_0::GnssMeasurement> measurements(1);
126 measurements[0] = measurement_2_0;
127 V1_0::IGnssMeasurementCallback::GnssClock clock = {.timeNs = 2713545000000,
128 .fullBiasNs = -1226701900521857520,
129 .biasNs = 0.59689998626708984,
130 .biasUncertaintyNs = 47514.989972114563,
131 .driftNsps = -51.757811607455452,
132 .driftUncertaintyNsps = 310.64968328491528,
133 .hwClockDiscontinuityCount = 1};
134
Yu-Han Yang04832302020-11-20 09:51:18 -0800135 V2_0::ElapsedRealtime timestamp = {
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700136 .flags = ElapsedRealtimeFlags::HAS_TIMESTAMP_NS |
137 ElapsedRealtimeFlags::HAS_TIME_UNCERTAINTY_NS,
138 .timestampNs = static_cast<uint64_t>(::android::elapsedRealtimeNano()),
139 // This is an hardcoded value indicating a 1ms of uncertainty between the two clocks.
140 // In an actual implementation provide an estimate of the synchronization uncertainty
141 // or don't set the field.
142 .timeUncertaintyNs = 1000000};
143
144 GnssDataV2_0 gnssData = {
145 .measurements = measurements, .clock = clock, .elapsedRealtime = timestamp};
146 return gnssData;
147}
148
Shinru Han4abab502020-12-09 15:07:18 +0800149GnssData Utils::getMockMeasurement(const bool enableCorrVecOutputs) {
Yu-Han Yang04832302020-11-20 09:51:18 -0800150 aidl::android::hardware::gnss::GnssSignalType signalType = {
Yu-Han Yang1afbd5f2021-11-24 16:39:13 -0800151 .constellation = GnssConstellationType::GLONASS,
Yu-Han Yang04832302020-11-20 09:51:18 -0800152 .carrierFrequencyHz = 1.59975e+09,
153 .codeType = aidl::android::hardware::gnss::GnssSignalType::CODE_TYPE_C,
154 };
Yu-Han Yangcfca8a72020-12-12 09:36:28 -0800155 GnssMeasurement measurement = {
156 .flags = GnssMeasurement::HAS_AUTOMATIC_GAIN_CONTROL |
157 GnssMeasurement::HAS_CARRIER_FREQUENCY | GnssMeasurement::HAS_CARRIER_PHASE |
158 GnssMeasurement::HAS_CARRIER_PHASE_UNCERTAINTY |
159 GnssMeasurement::HAS_FULL_ISB | GnssMeasurement::HAS_FULL_ISB_UNCERTAINTY |
160 GnssMeasurement::HAS_SATELLITE_ISB |
Joe Huang0d203ba2020-12-07 23:57:48 +0800161 GnssMeasurement::HAS_SATELLITE_ISB_UNCERTAINTY |
162 GnssMeasurement::HAS_SATELLITE_PVT,
Yu-Han Yangcfca8a72020-12-12 09:36:28 -0800163 .svid = 13,
Yu-Han Yang04832302020-11-20 09:51:18 -0800164 .signalType = signalType,
Yu-Han Yang04832302020-11-20 09:51:18 -0800165 .receivedSvTimeInNs = 8195997131077,
166 .receivedSvTimeUncertaintyInNs = 15,
167 .antennaCN0DbHz = 30.0,
Yu-Han Yangcfca8a72020-12-12 09:36:28 -0800168 .basebandCN0DbHz = 26.5,
169 .agcLevelDb = 2.3,
Yu-Han Yang04832302020-11-20 09:51:18 -0800170 .pseudorangeRateMps = -484.13739013671875,
171 .pseudorangeRateUncertaintyMps = 1.0379999876022339,
172 .accumulatedDeltaRangeState = GnssMeasurement::ADR_STATE_UNKNOWN,
Yu-Han Yangcfca8a72020-12-12 09:36:28 -0800173 .accumulatedDeltaRangeM = 1.52,
174 .accumulatedDeltaRangeUncertaintyM = 2.43,
Yu-Han Yang04832302020-11-20 09:51:18 -0800175 .multipathIndicator = aidl::android::hardware::gnss::GnssMultipathIndicator::UNKNOWN,
176 .state = GnssMeasurement::STATE_CODE_LOCK | GnssMeasurement::STATE_BIT_SYNC |
177 GnssMeasurement::STATE_SUBFRAME_SYNC | GnssMeasurement::STATE_TOW_DECODED |
178 GnssMeasurement::STATE_GLO_STRING_SYNC |
Yu-Han Yangcfca8a72020-12-12 09:36:28 -0800179 GnssMeasurement::STATE_GLO_TOD_DECODED,
180 .fullInterSignalBiasNs = 21.5,
181 .fullInterSignalBiasUncertaintyNs = 792.0,
182 .satelliteInterSignalBiasNs = 233.9,
183 .satelliteInterSignalBiasUncertaintyNs = 921.2,
Joe Huangf9853982021-05-08 13:27:29 +0800184 .satellitePvt = {.flags = SatellitePvt::HAS_POSITION_VELOCITY_CLOCK_INFO |
185 SatellitePvt::HAS_IONO | SatellitePvt::HAS_TROPO,
186 .satPosEcef = {.posXMeters = 10442993.1153328,
Joe Huang0d203ba2020-12-07 23:57:48 +0800187 .posYMeters = -19926932.8051666,
188 .posZMeters = -12034295.0216203,
189 .ureMeters = 1000.2345678},
190 .satVelEcef = {.velXMps = -478.667183715732,
191 .velYMps = 1580.68371984114,
192 .velZMps = -3030.52994449997,
193 .ureRateMps = 10.2345678},
194 .satClockInfo = {.satHardwareCodeBiasMeters = 1.396983861923e-09,
195 .satTimeCorrectionMeters = -7113.08964331,
196 .satClkDriftMps = 0},
197 .ionoDelayMeters = 3.069949602639317e-08,
Shinru Han4abab502020-12-09 15:07:18 +0800198 .tropoDelayMeters = 3.882265204404031},
199 .correlationVectors = {}};
Yu-Han Yang04832302020-11-20 09:51:18 -0800200
Yipeng Cao4e9b3b72021-01-23 00:29:52 +0000201 GnssClock clock = {.gnssClockFlags = GnssClock::HAS_FULL_BIAS | GnssClock::HAS_BIAS |
Yu-Han Yangcfca8a72020-12-12 09:36:28 -0800202 GnssClock::HAS_BIAS_UNCERTAINTY | GnssClock::HAS_DRIFT |
203 GnssClock::HAS_DRIFT_UNCERTAINTY,
Yuchen He3b681692021-08-10 22:59:47 +0000204 .timeNs = 2713545000000,
205 .fullBiasNs = -1226701900521857520,
206 .biasNs = 0.59689998626708984,
207 .biasUncertaintyNs = 47514.989972114563,
208 .driftNsps = -51.757811607455452,
209 .driftUncertaintyNsps = 310.64968328491528,
210 .hwClockDiscontinuityCount = 1};
Yu-Han Yang04832302020-11-20 09:51:18 -0800211
212 ElapsedRealtime timestamp = {
213 .flags = ElapsedRealtime::HAS_TIMESTAMP_NS | ElapsedRealtime::HAS_TIME_UNCERTAINTY_NS,
214 .timestampNs = ::android::elapsedRealtimeNano(),
215 // This is an hardcoded value indicating a 1ms of uncertainty between the two clocks.
216 // In an actual implementation provide an estimate of the synchronization uncertainty
217 // or don't set the field.
Yu-Han Yangcfca8a72020-12-12 09:36:28 -0800218 .timeUncertaintyNs = 1020400};
Yu-Han Yang04832302020-11-20 09:51:18 -0800219
Shinru Han4abab502020-12-09 15:07:18 +0800220 if (enableCorrVecOutputs) {
221 aidl::android::hardware::gnss::CorrelationVector correlationVector1 = {
222 .frequencyOffsetMps = 10,
223 .samplingWidthM = 30,
224 .samplingStartM = 0,
225 .magnitude = {0, 5000, 10000, 5000, 0, 0, 3000, 0}};
226 aidl::android::hardware::gnss::CorrelationVector correlationVector2 = {
227 .frequencyOffsetMps = 20,
228 .samplingWidthM = 30,
Shinru Han37f63ed2021-08-10 16:53:17 +0800229 .samplingStartM = -10,
Shinru Han4abab502020-12-09 15:07:18 +0800230 .magnitude = {0, 3000, 5000, 3000, 0, 0, 1000, 0}};
231 measurement.correlationVectors = {correlationVector1, correlationVector2};
232 measurement.flags |= GnssMeasurement::HAS_CORRELATION_VECTOR;
233 }
234
Yu-Han Yang406cb762021-12-28 12:14:22 -0800235 GnssAgc gnssAgc1 = {
236 .agcLevelDb = 3.5,
237 .constellation = GnssConstellationType::GLONASS,
238 .carrierFrequencyHz = (int64_t)kGloG1FreqHz,
239 };
240
241 GnssAgc gnssAgc2 = {
242 .agcLevelDb = -5.1,
243 .constellation = GnssConstellationType::GPS,
244 .carrierFrequencyHz = (int64_t)kGpsL1FreqHz,
245 };
246
247 GnssData gnssData = {.measurements = {measurement},
248 .clock = clock,
249 .elapsedRealtime = timestamp,
250 .gnssAgcs = std::make_optional(std::vector(
251 {std::make_optional(gnssAgc1), std::make_optional(gnssAgc2)}))};
Yu-Han Yang04832302020-11-20 09:51:18 -0800252 return gnssData;
253}
254
Yu-Han Yang3a75dc02021-09-27 01:01:06 -0700255GnssLocation Utils::getMockLocation() {
256 ElapsedRealtime elapsedRealtime = {
257 .flags = ElapsedRealtime::HAS_TIMESTAMP_NS | ElapsedRealtime::HAS_TIME_UNCERTAINTY_NS,
258 .timestampNs = ::android::elapsedRealtimeNano(),
259 // This is an hardcoded value indicating a 1ms of uncertainty between the two clocks.
260 // In an actual implementation provide an estimate of the synchronization uncertainty
261 // or don't set the field.
262 .timeUncertaintyNs = 1020400};
263 GnssLocation location = {.gnssLocationFlags = 0xFF,
264 .latitudeDegrees = gMockLatitudeDegrees,
265 .longitudeDegrees = gMockLongitudeDegrees,
266 .altitudeMeters = gMockAltitudeMeters,
267 .speedMetersPerSec = gMockSpeedMetersPerSec,
268 .bearingDegrees = gMockBearingDegrees,
269 .horizontalAccuracyMeters = kMockHorizontalAccuracyMeters,
270 .verticalAccuracyMeters = kMockVerticalAccuracyMeters,
271 .speedAccuracyMetersPerSecond = kMockSpeedAccuracyMetersPerSecond,
272 .bearingAccuracyDegrees = kMockBearingAccuracyDegrees,
273 .timestampMillis = static_cast<int64_t>(
274 kMockTimestamp + ::android::elapsedRealtimeNano() / 1e6),
275 .elapsedRealtime = elapsedRealtime};
276 return location;
277}
278
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700279V2_0::GnssLocation Utils::getMockLocationV2_0() {
280 const V2_0::ElapsedRealtime timestamp = {
281 .flags = V2_0::ElapsedRealtimeFlags::HAS_TIMESTAMP_NS |
282 V2_0::ElapsedRealtimeFlags::HAS_TIME_UNCERTAINTY_NS,
283 .timestampNs = static_cast<uint64_t>(::android::elapsedRealtimeNano()),
284 // This is an hardcoded value indicating a 1ms of uncertainty between the two clocks.
285 // In an actual implementation provide an estimate of the synchronization uncertainty
286 // or don't set the field.
287 .timeUncertaintyNs = 1000000};
288
289 V2_0::GnssLocation location = {.v1_0 = Utils::getMockLocationV1_0(),
290 .elapsedRealtime = timestamp};
Yu-Han Yanga5098612019-02-08 16:22:07 -0800291 return location;
292}
293
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700294V1_0::GnssLocation Utils::getMockLocationV1_0() {
295 V1_0::GnssLocation location = {
296 .gnssLocationFlags = 0xFF,
Enrico Granata3ba5d222020-10-21 17:20:00 -0600297 .latitudeDegrees = gMockLatitudeDegrees,
298 .longitudeDegrees = gMockLongitudeDegrees,
299 .altitudeMeters = gMockAltitudeMeters,
Enrico Granata72a47a22020-11-13 12:52:07 -0700300 .speedMetersPerSec = gMockSpeedMetersPerSec,
301 .bearingDegrees = gMockBearingDegrees,
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700302 .horizontalAccuracyMeters = kMockHorizontalAccuracyMeters,
303 .verticalAccuracyMeters = kMockVerticalAccuracyMeters,
304 .speedAccuracyMetersPerSecond = kMockSpeedAccuracyMetersPerSecond,
305 .bearingAccuracyDegrees = kMockBearingAccuracyDegrees,
Yu-Han Yangbcf3b222020-12-28 13:32:39 -0800306 .timestamp =
307 static_cast<int64_t>(kMockTimestamp + ::android::elapsedRealtimeNano() / 1e6)};
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700308 return location;
309}
310
Yu-Han Yang1afbd5f2021-11-24 16:39:13 -0800311namespace {
312GnssSvInfo getMockSvInfo(int svid, GnssConstellationType type, float cN0DbHz, float basebandCN0DbHz,
313 float elevationDegrees, float azimuthDegrees, long carrierFrequencyHz) {
314 GnssSvInfo svInfo = {
315 .svid = svid,
316 .constellation = type,
317 .cN0Dbhz = cN0DbHz,
318 .basebandCN0DbHz = basebandCN0DbHz,
319 .elevationDegrees = elevationDegrees,
320 .azimuthDegrees = azimuthDegrees,
321 .carrierFrequencyHz = carrierFrequencyHz,
322 .svFlag = (int)GnssSvFlags::USED_IN_FIX | (int)GnssSvFlags::HAS_EPHEMERIS_DATA |
323 (int)GnssSvFlags::HAS_ALMANAC_DATA | (int)GnssSvFlags::HAS_CARRIER_FREQUENCY};
324 return svInfo;
325}
326} // anonymous namespace
327
328std::vector<GnssSvInfo> Utils::getMockSvInfoList() {
329 std::vector<GnssSvInfo> gnssSvInfoList = {
330 getMockSvInfo(3, GnssConstellationType::GPS, 32.5, 27.5, 59.1, 166.5, kGpsL1FreqHz),
331 getMockSvInfo(5, GnssConstellationType::GPS, 27.0, 22.0, 29.0, 56.5, kGpsL1FreqHz),
332 getMockSvInfo(17, GnssConstellationType::GPS, 30.5, 25.5, 71.0, 77.0, kGpsL5FreqHz),
333 getMockSvInfo(26, GnssConstellationType::GPS, 24.1, 19.1, 28.0, 253.0, kGpsL5FreqHz),
334 getMockSvInfo(5, GnssConstellationType::GLONASS, 20.5, 15.5, 11.5, 116.0, kGloG1FreqHz),
335 getMockSvInfo(17, GnssConstellationType::GLONASS, 21.5, 16.5, 28.5, 186.0,
336 kGloG1FreqHz),
337 getMockSvInfo(18, GnssConstellationType::GLONASS, 28.3, 25.3, 38.8, 69.0, kGloG1FreqHz),
338 getMockSvInfo(10, GnssConstellationType::GLONASS, 25.0, 20.0, 66.0, 247.0,
339 kGloG1FreqHz),
340 getMockSvInfo(3, GnssConstellationType::IRNSS, 22.0, 19.7, 35.0, 112.0, kIrnssL5FreqHz),
341 };
342 return gnssSvInfoList;
343}
344
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700345hidl_vec<GnssSvInfoV2_1> Utils::getMockSvInfoListV2_1() {
Yu-Han Yang703ac962021-07-20 16:47:37 -0700346 GnssSvInfoV1_0 gnssSvInfoV1_0 = Utils::getMockSvInfoV1_0(3, V1_0::GnssConstellationType::GPS,
347 32.5, 59.1, 166.5, kGpsL1FreqHz);
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700348 GnssSvInfoV2_0 gnssSvInfoV2_0 =
349 Utils::getMockSvInfoV2_0(gnssSvInfoV1_0, V2_0::GnssConstellationType::GPS);
350 hidl_vec<GnssSvInfoV2_1> gnssSvInfoList = {
351 Utils::getMockSvInfoV2_1(gnssSvInfoV2_0, 27.5),
352 getMockSvInfoV2_1(
353 getMockSvInfoV2_0(getMockSvInfoV1_0(5, V1_0::GnssConstellationType::GPS, 27.0,
Yu-Han Yang703ac962021-07-20 16:47:37 -0700354 29.0, 56.5, kGpsL1FreqHz),
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700355 V2_0::GnssConstellationType::GPS),
356 22.0),
357 getMockSvInfoV2_1(
358 getMockSvInfoV2_0(getMockSvInfoV1_0(17, V1_0::GnssConstellationType::GPS, 30.5,
Yu-Han Yang703ac962021-07-20 16:47:37 -0700359 71.0, 77.0, kGpsL5FreqHz),
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700360 V2_0::GnssConstellationType::GPS),
361 25.5),
362 getMockSvInfoV2_1(
363 getMockSvInfoV2_0(getMockSvInfoV1_0(26, V1_0::GnssConstellationType::GPS, 24.1,
Yu-Han Yang703ac962021-07-20 16:47:37 -0700364 28.0, 253.0, kGpsL5FreqHz),
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700365 V2_0::GnssConstellationType::GPS),
366 19.1),
367 getMockSvInfoV2_1(
368 getMockSvInfoV2_0(getMockSvInfoV1_0(5, V1_0::GnssConstellationType::GLONASS,
Yu-Han Yang703ac962021-07-20 16:47:37 -0700369 20.5, 11.5, 116.0, kGloG1FreqHz),
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700370 V2_0::GnssConstellationType::GLONASS),
371 15.5),
372 getMockSvInfoV2_1(
373 getMockSvInfoV2_0(getMockSvInfoV1_0(17, V1_0::GnssConstellationType::GLONASS,
Yu-Han Yang703ac962021-07-20 16:47:37 -0700374 21.5, 28.5, 186.0, kGloG1FreqHz),
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700375 V2_0::GnssConstellationType::GLONASS),
376 16.5),
377 getMockSvInfoV2_1(
378 getMockSvInfoV2_0(getMockSvInfoV1_0(18, V1_0::GnssConstellationType::GLONASS,
Yu-Han Yang703ac962021-07-20 16:47:37 -0700379 28.3, 38.8, 69.0, kGloG1FreqHz),
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700380 V2_0::GnssConstellationType::GLONASS),
381 25.3),
382 getMockSvInfoV2_1(
383 getMockSvInfoV2_0(getMockSvInfoV1_0(10, V1_0::GnssConstellationType::GLONASS,
Yu-Han Yang703ac962021-07-20 16:47:37 -0700384 25.0, 66.0, 247.0, kGloG1FreqHz),
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700385 V2_0::GnssConstellationType::GLONASS),
386 20.0),
Sasha Kuznetsov845f6d52019-12-04 12:17:50 -0800387 getMockSvInfoV2_1(
388 getMockSvInfoV2_0(getMockSvInfoV1_0(3, V1_0::GnssConstellationType::UNKNOWN,
Yu-Han Yang703ac962021-07-20 16:47:37 -0700389 22.0, 35.0, 112.0, kIrnssL5FreqHz),
Sasha Kuznetsov845f6d52019-12-04 12:17:50 -0800390 V2_0::GnssConstellationType::IRNSS),
391 19.7),
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700392 };
393 return gnssSvInfoList;
394}
395
396GnssSvInfoV2_1 Utils::getMockSvInfoV2_1(GnssSvInfoV2_0 gnssSvInfoV2_0, float basebandCN0DbHz) {
397 GnssSvInfoV2_1 gnssSvInfoV2_1 = {
398 .v2_0 = gnssSvInfoV2_0,
399 .basebandCN0DbHz = basebandCN0DbHz,
400 };
401 return gnssSvInfoV2_1;
402}
403
404GnssSvInfoV2_0 Utils::getMockSvInfoV2_0(GnssSvInfoV1_0 gnssSvInfoV1_0,
405 V2_0::GnssConstellationType type) {
406 GnssSvInfoV2_0 gnssSvInfoV2_0 = {
407 .v1_0 = gnssSvInfoV1_0,
408 .constellation = type,
409 };
410 return gnssSvInfoV2_0;
411}
412
413GnssSvInfoV1_0 Utils::getMockSvInfoV1_0(int16_t svid, V1_0::GnssConstellationType type,
Yu-Han Yang703ac962021-07-20 16:47:37 -0700414 float cN0DbHz, float elevationDegrees, float azimuthDegrees,
415 float carrierFrequencyHz) {
Yu-Han Yang1afbd5f2021-11-24 16:39:13 -0800416 GnssSvInfoV1_0 svInfo = {
417 .svid = svid,
418 .constellation = type,
419 .cN0Dbhz = cN0DbHz,
420 .elevationDegrees = elevationDegrees,
421 .azimuthDegrees = azimuthDegrees,
422 .carrierFrequencyHz = carrierFrequencyHz,
423 .svFlag = GnssSvFlagsV1_0::USED_IN_FIX | GnssSvFlagsV1_0::HAS_EPHEMERIS_DATA |
424 GnssSvFlagsV1_0::HAS_ALMANAC_DATA | GnssSvFlagsV1_0::HAS_CARRIER_FREQUENCY};
Yu-Han Yanga5098612019-02-08 16:22:07 -0800425 return svInfo;
426}
427
Sasha Kuznetsov768de572020-02-11 06:00:10 +0000428hidl_vec<GnssAntennaInfo> Utils::getMockAntennaInfos() {
429 GnssAntennaInfo mockAntennaInfo_1 = {
Yu-Han Yang703ac962021-07-20 16:47:37 -0700430 .carrierFrequencyMHz = kGpsL1FreqHz * 1e-6,
Sasha Kuznetsov768de572020-02-11 06:00:10 +0000431 .phaseCenterOffsetCoordinateMillimeters = Coord{.x = 1,
432 .xUncertainty = 0.1,
433 .y = 2,
434 .yUncertainty = 0.1,
435 .z = 3,
436 .zUncertainty = 0.1},
437 .phaseCenterVariationCorrectionMillimeters =
438 {
439 Row{hidl_vec<double>{1, -1, 5, -2, 3, -1}},
440 Row{hidl_vec<double>{-2, 3, 2, 0, 1, 2}},
441 Row{hidl_vec<double>{1, 3, 2, -1, -3, 5}},
442 },
443 .phaseCenterVariationCorrectionUncertaintyMillimeters =
444 {
445 Row{hidl_vec<double>{0.1, 0.2, 0.4, 0.1, 0.2, 0.3}},
446 Row{hidl_vec<double>{0.3, 0.2, 0.3, 0.6, 0.1, 0.1}},
447 Row{hidl_vec<double>{0.1, 0.1, 0.4, 0.2, 0.5, 0.3}},
448 },
449 .signalGainCorrectionDbi =
450 {
451 Row{hidl_vec<double>{2, -3, 1, -3, 0, -4}},
452 Row{hidl_vec<double>{1, 0, -4, 1, 3, -2}},
453 Row{hidl_vec<double>{3, -2, 0, -2, 3, 0}},
454 },
455 .signalGainCorrectionUncertaintyDbi =
456 {
457 Row{hidl_vec<double>{0.3, 0.1, 0.2, 0.6, 0.1, 0.3}},
458 Row{hidl_vec<double>{0.1, 0.1, 0.5, 0.2, 0.3, 0.1}},
459 Row{hidl_vec<double>{0.2, 0.4, 0.2, 0.1, 0.1, 0.2}},
460 },
461 };
462
463 GnssAntennaInfo mockAntennaInfo_2 = {
Yu-Han Yang703ac962021-07-20 16:47:37 -0700464 .carrierFrequencyMHz = kGpsL5FreqHz * 1e-6,
Sasha Kuznetsov768de572020-02-11 06:00:10 +0000465 .phaseCenterOffsetCoordinateMillimeters = Coord{.x = 5,
466 .xUncertainty = 0.1,
467 .y = 6,
468 .yUncertainty = 0.1,
469 .z = 7,
470 .zUncertainty = 0.1},
471 };
472
473 hidl_vec<GnssAntennaInfo> mockAntennaInfos = {
474 mockAntennaInfo_1,
475 mockAntennaInfo_2,
476 };
477 return mockAntennaInfos;
478}
479
Yu-Han Yanga5098612019-02-08 16:22:07 -0800480} // namespace common
481} // namespace gnss
482} // namespace hardware
483} // namespace android