blob: 4de49f376c4791a7e8b3daca158d225d07df4b61 [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;
Yu-Han Yang19c2d9b2022-01-14 14:45:30 -080035using aidl::android::hardware::gnss::IGnssDebug;
Yu-Han Yangcfca8a72020-12-12 09:36:28 -080036using aidl::android::hardware::gnss::IGnssMeasurementCallback;
Joe Huangf9853982021-05-08 13:27:29 +080037using aidl::android::hardware::gnss::SatellitePvt;
Yu-Han Yang1afbd5f2021-11-24 16:39:13 -080038using GnssSvInfo = aidl::android::hardware::gnss::IGnssCallback::GnssSvInfo;
39using GnssSvFlags = aidl::android::hardware::gnss::IGnssCallback::GnssSvFlags;
Yu-Han Yangcfca8a72020-12-12 09:36:28 -080040
Yu-Han Yang1afbd5f2021-11-24 16:39:13 -080041using GnssSvFlagsV1_0 = V1_0::IGnssCallback::GnssSvFlags;
Yu-Han Yang406cb762021-12-28 12:14:22 -080042using GnssAgc = aidl::android::hardware::gnss::GnssData::GnssAgc;
Yu-Han Yang5fe14fa2019-12-03 20:54:53 -080043using GnssMeasurementFlagsV1_0 = V1_0::IGnssMeasurementCallback::GnssMeasurementFlags;
44using GnssMeasurementFlagsV2_1 = V2_1::IGnssMeasurementCallback::GnssMeasurementFlags;
Yu-Han Yangc06b5362019-10-25 14:14:35 -070045using GnssMeasurementStateV2_0 = V2_0::IGnssMeasurementCallback::GnssMeasurementState;
Yu-Han Yangc06b5362019-10-25 14:14:35 -070046using ElapsedRealtimeFlags = V2_0::ElapsedRealtimeFlags;
47using GnssConstellationTypeV2_0 = V2_0::GnssConstellationType;
48using IGnssMeasurementCallbackV2_0 = V2_0::IGnssMeasurementCallback;
Yu-Han Yang5fe14fa2019-12-03 20:54:53 -080049using GnssSignalType = V2_1::GnssSignalType;
Yu-Han Yanga5098612019-02-08 16:22:07 -080050
Yu-Han Yang04832302020-11-20 09:51:18 -080051using GnssDataV2_0 = V2_0::IGnssMeasurementCallback::GnssData;
52using GnssDataV2_1 = V2_1::IGnssMeasurementCallback::GnssData;
53using GnssSvInfoV1_0 = V1_0::IGnssCallback::GnssSvInfo;
54using GnssSvInfoV2_0 = V2_0::IGnssCallback::GnssSvInfo;
55using GnssSvInfoV2_1 = V2_1::IGnssCallback::GnssSvInfo;
56using GnssAntennaInfo = ::android::hardware::gnss::V2_1::IGnssAntennaInfoCallback::GnssAntennaInfo;
57using Row = V2_1::IGnssAntennaInfoCallback::Row;
58using Coord = V2_1::IGnssAntennaInfoCallback::Coord;
59
Yu-Han Yangc06b5362019-10-25 14:14:35 -070060GnssDataV2_1 Utils::getMockMeasurementV2_1() {
61 GnssDataV2_0 gnssDataV2_0 = Utils::getMockMeasurementV2_0();
62 V2_1::IGnssMeasurementCallback::GnssMeasurement gnssMeasurementV2_1 = {
63 .v2_0 = gnssDataV2_0.measurements[0],
Yu-Han Yang5fe14fa2019-12-03 20:54:53 -080064 .flags = (uint32_t)(GnssMeasurementFlagsV2_1::HAS_CARRIER_FREQUENCY |
65 GnssMeasurementFlagsV2_1::HAS_CARRIER_PHASE |
Yu-Han Yang6668eab2020-03-03 15:23:50 -080066 GnssMeasurementFlagsV2_1::HAS_FULL_ISB |
67 GnssMeasurementFlagsV2_1::HAS_FULL_ISB_UNCERTAINTY |
Yu-Han Yang5fe14fa2019-12-03 20:54:53 -080068 GnssMeasurementFlagsV2_1::HAS_SATELLITE_ISB |
69 GnssMeasurementFlagsV2_1::HAS_SATELLITE_ISB_UNCERTAINTY),
Yu-Han Yang6668eab2020-03-03 15:23:50 -080070 .fullInterSignalBiasNs = 30.0,
71 .fullInterSignalBiasUncertaintyNs = 250.0,
Yu-Han Yang5fe14fa2019-12-03 20:54:53 -080072 .satelliteInterSignalBiasNs = 20.0,
73 .satelliteInterSignalBiasUncertaintyNs = 150.0,
Yu-Han Yangc06b5362019-10-25 14:14:35 -070074 .basebandCN0DbHz = 25.0,
75 };
Yu-Han Yang5fe14fa2019-12-03 20:54:53 -080076 GnssSignalType referenceSignalTypeForIsb = {
77 .constellation = GnssConstellationTypeV2_0::GPS,
78 .carrierFrequencyHz = 1.59975e+09,
79 .codeType = "C",
80 };
81 V2_1::IGnssMeasurementCallback::GnssClock gnssClockV2_1 = {
82 .v1_0 = gnssDataV2_0.clock,
83 .referenceSignalTypeForIsb = referenceSignalTypeForIsb,
84 };
Yu-Han Yangc06b5362019-10-25 14:14:35 -070085 hidl_vec<V2_1::IGnssMeasurementCallback::GnssMeasurement> measurements(1);
86 measurements[0] = gnssMeasurementV2_1;
87 GnssDataV2_1 gnssDataV2_1 = {
88 .measurements = measurements,
Yu-Han Yang5fe14fa2019-12-03 20:54:53 -080089 .clock = gnssClockV2_1,
Yu-Han Yangc06b5362019-10-25 14:14:35 -070090 .elapsedRealtime = gnssDataV2_0.elapsedRealtime,
91 };
92 return gnssDataV2_1;
93}
94
95GnssDataV2_0 Utils::getMockMeasurementV2_0() {
96 V1_0::IGnssMeasurementCallback::GnssMeasurement measurement_1_0 = {
Yu-Han Yang5fe14fa2019-12-03 20:54:53 -080097 .flags = (uint32_t)GnssMeasurementFlagsV1_0::HAS_CARRIER_FREQUENCY,
Yu-Han Yangc06b5362019-10-25 14:14:35 -070098 .svid = (int16_t)6,
99 .constellation = V1_0::GnssConstellationType::UNKNOWN,
100 .timeOffsetNs = 0.0,
101 .receivedSvTimeInNs = 8195997131077,
102 .receivedSvTimeUncertaintyInNs = 15,
103 .cN0DbHz = 30.0,
104 .pseudorangeRateMps = -484.13739013671875,
105 .pseudorangeRateUncertaintyMps = 1.0379999876022339,
106 .accumulatedDeltaRangeState = (uint32_t)V1_0::IGnssMeasurementCallback::
107 GnssAccumulatedDeltaRangeState::ADR_STATE_UNKNOWN,
108 .accumulatedDeltaRangeM = 0.0,
109 .accumulatedDeltaRangeUncertaintyM = 0.0,
110 .carrierFrequencyHz = 1.59975e+09,
111 .multipathIndicator =
112 V1_0::IGnssMeasurementCallback::GnssMultipathIndicator::INDICATOR_UNKNOWN};
113 V1_1::IGnssMeasurementCallback::GnssMeasurement measurement_1_1 = {.v1_0 = measurement_1_0};
114 V2_0::IGnssMeasurementCallback::GnssMeasurement measurement_2_0 = {
115 .v1_1 = measurement_1_1,
116 .codeType = "C",
117 .state = GnssMeasurementStateV2_0::STATE_CODE_LOCK |
118 GnssMeasurementStateV2_0::STATE_BIT_SYNC |
119 GnssMeasurementStateV2_0::STATE_SUBFRAME_SYNC |
120 GnssMeasurementStateV2_0::STATE_TOW_DECODED |
121 GnssMeasurementStateV2_0::STATE_GLO_STRING_SYNC |
122 GnssMeasurementStateV2_0::STATE_GLO_TOD_DECODED,
123 .constellation = GnssConstellationTypeV2_0::GLONASS,
124 };
125
126 hidl_vec<IGnssMeasurementCallbackV2_0::GnssMeasurement> measurements(1);
127 measurements[0] = measurement_2_0;
128 V1_0::IGnssMeasurementCallback::GnssClock clock = {.timeNs = 2713545000000,
129 .fullBiasNs = -1226701900521857520,
130 .biasNs = 0.59689998626708984,
131 .biasUncertaintyNs = 47514.989972114563,
132 .driftNsps = -51.757811607455452,
133 .driftUncertaintyNsps = 310.64968328491528,
134 .hwClockDiscontinuityCount = 1};
135
Yu-Han Yang04832302020-11-20 09:51:18 -0800136 V2_0::ElapsedRealtime timestamp = {
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700137 .flags = ElapsedRealtimeFlags::HAS_TIMESTAMP_NS |
138 ElapsedRealtimeFlags::HAS_TIME_UNCERTAINTY_NS,
139 .timestampNs = static_cast<uint64_t>(::android::elapsedRealtimeNano()),
140 // This is an hardcoded value indicating a 1ms of uncertainty between the two clocks.
141 // In an actual implementation provide an estimate of the synchronization uncertainty
142 // or don't set the field.
143 .timeUncertaintyNs = 1000000};
144
145 GnssDataV2_0 gnssData = {
146 .measurements = measurements, .clock = clock, .elapsedRealtime = timestamp};
147 return gnssData;
148}
149
Shinru Han4abab502020-12-09 15:07:18 +0800150GnssData Utils::getMockMeasurement(const bool enableCorrVecOutputs) {
Yu-Han Yang04832302020-11-20 09:51:18 -0800151 aidl::android::hardware::gnss::GnssSignalType signalType = {
Yu-Han Yang1afbd5f2021-11-24 16:39:13 -0800152 .constellation = GnssConstellationType::GLONASS,
Yu-Han Yang04832302020-11-20 09:51:18 -0800153 .carrierFrequencyHz = 1.59975e+09,
154 .codeType = aidl::android::hardware::gnss::GnssSignalType::CODE_TYPE_C,
155 };
Yu-Han Yangcfca8a72020-12-12 09:36:28 -0800156 GnssMeasurement measurement = {
157 .flags = GnssMeasurement::HAS_AUTOMATIC_GAIN_CONTROL |
158 GnssMeasurement::HAS_CARRIER_FREQUENCY | GnssMeasurement::HAS_CARRIER_PHASE |
159 GnssMeasurement::HAS_CARRIER_PHASE_UNCERTAINTY |
160 GnssMeasurement::HAS_FULL_ISB | GnssMeasurement::HAS_FULL_ISB_UNCERTAINTY |
161 GnssMeasurement::HAS_SATELLITE_ISB |
Joe Huang0d203ba2020-12-07 23:57:48 +0800162 GnssMeasurement::HAS_SATELLITE_ISB_UNCERTAINTY |
163 GnssMeasurement::HAS_SATELLITE_PVT,
Yu-Han Yangcfca8a72020-12-12 09:36:28 -0800164 .svid = 13,
Yu-Han Yang04832302020-11-20 09:51:18 -0800165 .signalType = signalType,
Yu-Han Yang04832302020-11-20 09:51:18 -0800166 .receivedSvTimeInNs = 8195997131077,
167 .receivedSvTimeUncertaintyInNs = 15,
168 .antennaCN0DbHz = 30.0,
Yu-Han Yangcfca8a72020-12-12 09:36:28 -0800169 .basebandCN0DbHz = 26.5,
170 .agcLevelDb = 2.3,
Yu-Han Yang04832302020-11-20 09:51:18 -0800171 .pseudorangeRateMps = -484.13739013671875,
172 .pseudorangeRateUncertaintyMps = 1.0379999876022339,
173 .accumulatedDeltaRangeState = GnssMeasurement::ADR_STATE_UNKNOWN,
Yu-Han Yangcfca8a72020-12-12 09:36:28 -0800174 .accumulatedDeltaRangeM = 1.52,
175 .accumulatedDeltaRangeUncertaintyM = 2.43,
Yu-Han Yang04832302020-11-20 09:51:18 -0800176 .multipathIndicator = aidl::android::hardware::gnss::GnssMultipathIndicator::UNKNOWN,
177 .state = GnssMeasurement::STATE_CODE_LOCK | GnssMeasurement::STATE_BIT_SYNC |
178 GnssMeasurement::STATE_SUBFRAME_SYNC | GnssMeasurement::STATE_TOW_DECODED |
179 GnssMeasurement::STATE_GLO_STRING_SYNC |
Yu-Han Yangcfca8a72020-12-12 09:36:28 -0800180 GnssMeasurement::STATE_GLO_TOD_DECODED,
181 .fullInterSignalBiasNs = 21.5,
182 .fullInterSignalBiasUncertaintyNs = 792.0,
183 .satelliteInterSignalBiasNs = 233.9,
184 .satelliteInterSignalBiasUncertaintyNs = 921.2,
Yu-Han Yang19c2d9b2022-01-14 14:45:30 -0800185 .satellitePvt =
186 {
187 .flags = SatellitePvt::HAS_POSITION_VELOCITY_CLOCK_INFO |
188 SatellitePvt::HAS_IONO | SatellitePvt::HAS_TROPO,
189 .satPosEcef = {.posXMeters = 10442993.1153328,
190 .posYMeters = -19926932.8051666,
191 .posZMeters = -12034295.0216203,
192 .ureMeters = 1000.2345678},
193 .satVelEcef = {.velXMps = -478.667183715732,
194 .velYMps = 1580.68371984114,
195 .velZMps = -3030.52994449997,
196 .ureRateMps = 10.2345678},
197 .satClockInfo = {.satHardwareCodeBiasMeters = 1.396983861923e-09,
198 .satTimeCorrectionMeters = -7113.08964331,
199 .satClkDriftMps = 0},
200 .ionoDelayMeters = 3.069949602639317e-08,
201 .tropoDelayMeters = 3.882265204404031,
202 .ephemerisSource =
203 SatellitePvt::SatelliteEphemerisSource::SERVER_LONG_TERM,
Yu-Han Yangc2fb3182022-02-14 14:20:14 -0800204 .timeOfClockSeconds = 12345,
205 .issueOfDataClock = 143,
206 .timeOfEphemerisSeconds = 9876,
207 .issueOfDataEphemeris = 48,
Yu-Han Yang19c2d9b2022-01-14 14:45:30 -0800208 },
Shinru Han4abab502020-12-09 15:07:18 +0800209 .correlationVectors = {}};
Yu-Han Yang04832302020-11-20 09:51:18 -0800210
Yipeng Cao4e9b3b72021-01-23 00:29:52 +0000211 GnssClock clock = {.gnssClockFlags = GnssClock::HAS_FULL_BIAS | GnssClock::HAS_BIAS |
Yu-Han Yangcfca8a72020-12-12 09:36:28 -0800212 GnssClock::HAS_BIAS_UNCERTAINTY | GnssClock::HAS_DRIFT |
213 GnssClock::HAS_DRIFT_UNCERTAINTY,
Yuchen He3b681692021-08-10 22:59:47 +0000214 .timeNs = 2713545000000,
215 .fullBiasNs = -1226701900521857520,
216 .biasNs = 0.59689998626708984,
217 .biasUncertaintyNs = 47514.989972114563,
218 .driftNsps = -51.757811607455452,
219 .driftUncertaintyNsps = 310.64968328491528,
Yu-Han Yang4165ed12022-02-09 14:47:50 -0800220 .hwClockDiscontinuityCount = 1,
221 .referenceSignalTypeForIsb = signalType};
Yu-Han Yang04832302020-11-20 09:51:18 -0800222
223 ElapsedRealtime timestamp = {
224 .flags = ElapsedRealtime::HAS_TIMESTAMP_NS | ElapsedRealtime::HAS_TIME_UNCERTAINTY_NS,
225 .timestampNs = ::android::elapsedRealtimeNano(),
226 // This is an hardcoded value indicating a 1ms of uncertainty between the two clocks.
227 // In an actual implementation provide an estimate of the synchronization uncertainty
228 // or don't set the field.
Yu-Han Yangcfca8a72020-12-12 09:36:28 -0800229 .timeUncertaintyNs = 1020400};
Yu-Han Yang04832302020-11-20 09:51:18 -0800230
Shinru Han4abab502020-12-09 15:07:18 +0800231 if (enableCorrVecOutputs) {
232 aidl::android::hardware::gnss::CorrelationVector correlationVector1 = {
233 .frequencyOffsetMps = 10,
234 .samplingWidthM = 30,
235 .samplingStartM = 0,
236 .magnitude = {0, 5000, 10000, 5000, 0, 0, 3000, 0}};
237 aidl::android::hardware::gnss::CorrelationVector correlationVector2 = {
238 .frequencyOffsetMps = 20,
239 .samplingWidthM = 30,
Shinru Han37f63ed2021-08-10 16:53:17 +0800240 .samplingStartM = -10,
Shinru Han4abab502020-12-09 15:07:18 +0800241 .magnitude = {0, 3000, 5000, 3000, 0, 0, 1000, 0}};
242 measurement.correlationVectors = {correlationVector1, correlationVector2};
243 measurement.flags |= GnssMeasurement::HAS_CORRELATION_VECTOR;
244 }
245
Yu-Han Yang406cb762021-12-28 12:14:22 -0800246 GnssAgc gnssAgc1 = {
247 .agcLevelDb = 3.5,
248 .constellation = GnssConstellationType::GLONASS,
249 .carrierFrequencyHz = (int64_t)kGloG1FreqHz,
250 };
251
252 GnssAgc gnssAgc2 = {
253 .agcLevelDb = -5.1,
254 .constellation = GnssConstellationType::GPS,
255 .carrierFrequencyHz = (int64_t)kGpsL1FreqHz,
256 };
257
258 GnssData gnssData = {.measurements = {measurement},
259 .clock = clock,
260 .elapsedRealtime = timestamp,
Yu-Han Yang75934f72022-01-24 15:35:25 -0800261 .gnssAgcs = std::vector({gnssAgc1, gnssAgc2})};
Yu-Han Yang04832302020-11-20 09:51:18 -0800262 return gnssData;
263}
264
Yu-Han Yang3a75dc02021-09-27 01:01:06 -0700265GnssLocation Utils::getMockLocation() {
266 ElapsedRealtime elapsedRealtime = {
267 .flags = ElapsedRealtime::HAS_TIMESTAMP_NS | ElapsedRealtime::HAS_TIME_UNCERTAINTY_NS,
268 .timestampNs = ::android::elapsedRealtimeNano(),
269 // This is an hardcoded value indicating a 1ms of uncertainty between the two clocks.
270 // In an actual implementation provide an estimate of the synchronization uncertainty
271 // or don't set the field.
272 .timeUncertaintyNs = 1020400};
273 GnssLocation location = {.gnssLocationFlags = 0xFF,
274 .latitudeDegrees = gMockLatitudeDegrees,
275 .longitudeDegrees = gMockLongitudeDegrees,
276 .altitudeMeters = gMockAltitudeMeters,
277 .speedMetersPerSec = gMockSpeedMetersPerSec,
278 .bearingDegrees = gMockBearingDegrees,
279 .horizontalAccuracyMeters = kMockHorizontalAccuracyMeters,
280 .verticalAccuracyMeters = kMockVerticalAccuracyMeters,
281 .speedAccuracyMetersPerSecond = kMockSpeedAccuracyMetersPerSecond,
282 .bearingAccuracyDegrees = kMockBearingAccuracyDegrees,
283 .timestampMillis = static_cast<int64_t>(
284 kMockTimestamp + ::android::elapsedRealtimeNano() / 1e6),
285 .elapsedRealtime = elapsedRealtime};
286 return location;
287}
288
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700289V2_0::GnssLocation Utils::getMockLocationV2_0() {
290 const V2_0::ElapsedRealtime timestamp = {
291 .flags = V2_0::ElapsedRealtimeFlags::HAS_TIMESTAMP_NS |
292 V2_0::ElapsedRealtimeFlags::HAS_TIME_UNCERTAINTY_NS,
293 .timestampNs = static_cast<uint64_t>(::android::elapsedRealtimeNano()),
294 // This is an hardcoded value indicating a 1ms of uncertainty between the two clocks.
295 // In an actual implementation provide an estimate of the synchronization uncertainty
296 // or don't set the field.
297 .timeUncertaintyNs = 1000000};
298
299 V2_0::GnssLocation location = {.v1_0 = Utils::getMockLocationV1_0(),
300 .elapsedRealtime = timestamp};
Yu-Han Yanga5098612019-02-08 16:22:07 -0800301 return location;
302}
303
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700304V1_0::GnssLocation Utils::getMockLocationV1_0() {
305 V1_0::GnssLocation location = {
306 .gnssLocationFlags = 0xFF,
Enrico Granata3ba5d222020-10-21 17:20:00 -0600307 .latitudeDegrees = gMockLatitudeDegrees,
308 .longitudeDegrees = gMockLongitudeDegrees,
309 .altitudeMeters = gMockAltitudeMeters,
Enrico Granata72a47a22020-11-13 12:52:07 -0700310 .speedMetersPerSec = gMockSpeedMetersPerSec,
311 .bearingDegrees = gMockBearingDegrees,
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700312 .horizontalAccuracyMeters = kMockHorizontalAccuracyMeters,
313 .verticalAccuracyMeters = kMockVerticalAccuracyMeters,
314 .speedAccuracyMetersPerSecond = kMockSpeedAccuracyMetersPerSecond,
315 .bearingAccuracyDegrees = kMockBearingAccuracyDegrees,
Yu-Han Yangbcf3b222020-12-28 13:32:39 -0800316 .timestamp =
317 static_cast<int64_t>(kMockTimestamp + ::android::elapsedRealtimeNano() / 1e6)};
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700318 return location;
319}
320
Yu-Han Yang1afbd5f2021-11-24 16:39:13 -0800321namespace {
322GnssSvInfo getMockSvInfo(int svid, GnssConstellationType type, float cN0DbHz, float basebandCN0DbHz,
323 float elevationDegrees, float azimuthDegrees, long carrierFrequencyHz) {
324 GnssSvInfo svInfo = {
325 .svid = svid,
326 .constellation = type,
327 .cN0Dbhz = cN0DbHz,
328 .basebandCN0DbHz = basebandCN0DbHz,
329 .elevationDegrees = elevationDegrees,
330 .azimuthDegrees = azimuthDegrees,
331 .carrierFrequencyHz = carrierFrequencyHz,
332 .svFlag = (int)GnssSvFlags::USED_IN_FIX | (int)GnssSvFlags::HAS_EPHEMERIS_DATA |
333 (int)GnssSvFlags::HAS_ALMANAC_DATA | (int)GnssSvFlags::HAS_CARRIER_FREQUENCY};
334 return svInfo;
335}
336} // anonymous namespace
337
338std::vector<GnssSvInfo> Utils::getMockSvInfoList() {
339 std::vector<GnssSvInfo> gnssSvInfoList = {
340 getMockSvInfo(3, GnssConstellationType::GPS, 32.5, 27.5, 59.1, 166.5, kGpsL1FreqHz),
341 getMockSvInfo(5, GnssConstellationType::GPS, 27.0, 22.0, 29.0, 56.5, kGpsL1FreqHz),
342 getMockSvInfo(17, GnssConstellationType::GPS, 30.5, 25.5, 71.0, 77.0, kGpsL5FreqHz),
343 getMockSvInfo(26, GnssConstellationType::GPS, 24.1, 19.1, 28.0, 253.0, kGpsL5FreqHz),
344 getMockSvInfo(5, GnssConstellationType::GLONASS, 20.5, 15.5, 11.5, 116.0, kGloG1FreqHz),
345 getMockSvInfo(17, GnssConstellationType::GLONASS, 21.5, 16.5, 28.5, 186.0,
346 kGloG1FreqHz),
347 getMockSvInfo(18, GnssConstellationType::GLONASS, 28.3, 25.3, 38.8, 69.0, kGloG1FreqHz),
348 getMockSvInfo(10, GnssConstellationType::GLONASS, 25.0, 20.0, 66.0, 247.0,
349 kGloG1FreqHz),
350 getMockSvInfo(3, GnssConstellationType::IRNSS, 22.0, 19.7, 35.0, 112.0, kIrnssL5FreqHz),
351 };
352 return gnssSvInfoList;
353}
354
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700355hidl_vec<GnssSvInfoV2_1> Utils::getMockSvInfoListV2_1() {
Yu-Han Yang703ac962021-07-20 16:47:37 -0700356 GnssSvInfoV1_0 gnssSvInfoV1_0 = Utils::getMockSvInfoV1_0(3, V1_0::GnssConstellationType::GPS,
357 32.5, 59.1, 166.5, kGpsL1FreqHz);
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700358 GnssSvInfoV2_0 gnssSvInfoV2_0 =
359 Utils::getMockSvInfoV2_0(gnssSvInfoV1_0, V2_0::GnssConstellationType::GPS);
360 hidl_vec<GnssSvInfoV2_1> gnssSvInfoList = {
361 Utils::getMockSvInfoV2_1(gnssSvInfoV2_0, 27.5),
362 getMockSvInfoV2_1(
363 getMockSvInfoV2_0(getMockSvInfoV1_0(5, V1_0::GnssConstellationType::GPS, 27.0,
Yu-Han Yang703ac962021-07-20 16:47:37 -0700364 29.0, 56.5, kGpsL1FreqHz),
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700365 V2_0::GnssConstellationType::GPS),
366 22.0),
367 getMockSvInfoV2_1(
368 getMockSvInfoV2_0(getMockSvInfoV1_0(17, V1_0::GnssConstellationType::GPS, 30.5,
Yu-Han Yang703ac962021-07-20 16:47:37 -0700369 71.0, 77.0, kGpsL5FreqHz),
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700370 V2_0::GnssConstellationType::GPS),
371 25.5),
372 getMockSvInfoV2_1(
373 getMockSvInfoV2_0(getMockSvInfoV1_0(26, V1_0::GnssConstellationType::GPS, 24.1,
Yu-Han Yang703ac962021-07-20 16:47:37 -0700374 28.0, 253.0, kGpsL5FreqHz),
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700375 V2_0::GnssConstellationType::GPS),
376 19.1),
377 getMockSvInfoV2_1(
378 getMockSvInfoV2_0(getMockSvInfoV1_0(5, V1_0::GnssConstellationType::GLONASS,
Yu-Han Yang703ac962021-07-20 16:47:37 -0700379 20.5, 11.5, 116.0, kGloG1FreqHz),
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700380 V2_0::GnssConstellationType::GLONASS),
381 15.5),
382 getMockSvInfoV2_1(
383 getMockSvInfoV2_0(getMockSvInfoV1_0(17, V1_0::GnssConstellationType::GLONASS,
Yu-Han Yang703ac962021-07-20 16:47:37 -0700384 21.5, 28.5, 186.0, kGloG1FreqHz),
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700385 V2_0::GnssConstellationType::GLONASS),
386 16.5),
387 getMockSvInfoV2_1(
388 getMockSvInfoV2_0(getMockSvInfoV1_0(18, V1_0::GnssConstellationType::GLONASS,
Yu-Han Yang703ac962021-07-20 16:47:37 -0700389 28.3, 38.8, 69.0, kGloG1FreqHz),
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700390 V2_0::GnssConstellationType::GLONASS),
391 25.3),
392 getMockSvInfoV2_1(
393 getMockSvInfoV2_0(getMockSvInfoV1_0(10, V1_0::GnssConstellationType::GLONASS,
Yu-Han Yang703ac962021-07-20 16:47:37 -0700394 25.0, 66.0, 247.0, kGloG1FreqHz),
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700395 V2_0::GnssConstellationType::GLONASS),
396 20.0),
Sasha Kuznetsov845f6d52019-12-04 12:17:50 -0800397 getMockSvInfoV2_1(
398 getMockSvInfoV2_0(getMockSvInfoV1_0(3, V1_0::GnssConstellationType::UNKNOWN,
Yu-Han Yang703ac962021-07-20 16:47:37 -0700399 22.0, 35.0, 112.0, kIrnssL5FreqHz),
Sasha Kuznetsov845f6d52019-12-04 12:17:50 -0800400 V2_0::GnssConstellationType::IRNSS),
401 19.7),
Yu-Han Yangc06b5362019-10-25 14:14:35 -0700402 };
403 return gnssSvInfoList;
404}
405
406GnssSvInfoV2_1 Utils::getMockSvInfoV2_1(GnssSvInfoV2_0 gnssSvInfoV2_0, float basebandCN0DbHz) {
407 GnssSvInfoV2_1 gnssSvInfoV2_1 = {
408 .v2_0 = gnssSvInfoV2_0,
409 .basebandCN0DbHz = basebandCN0DbHz,
410 };
411 return gnssSvInfoV2_1;
412}
413
414GnssSvInfoV2_0 Utils::getMockSvInfoV2_0(GnssSvInfoV1_0 gnssSvInfoV1_0,
415 V2_0::GnssConstellationType type) {
416 GnssSvInfoV2_0 gnssSvInfoV2_0 = {
417 .v1_0 = gnssSvInfoV1_0,
418 .constellation = type,
419 };
420 return gnssSvInfoV2_0;
421}
422
423GnssSvInfoV1_0 Utils::getMockSvInfoV1_0(int16_t svid, V1_0::GnssConstellationType type,
Yu-Han Yang703ac962021-07-20 16:47:37 -0700424 float cN0DbHz, float elevationDegrees, float azimuthDegrees,
425 float carrierFrequencyHz) {
Yu-Han Yang1afbd5f2021-11-24 16:39:13 -0800426 GnssSvInfoV1_0 svInfo = {
427 .svid = svid,
428 .constellation = type,
429 .cN0Dbhz = cN0DbHz,
430 .elevationDegrees = elevationDegrees,
431 .azimuthDegrees = azimuthDegrees,
432 .carrierFrequencyHz = carrierFrequencyHz,
433 .svFlag = GnssSvFlagsV1_0::USED_IN_FIX | GnssSvFlagsV1_0::HAS_EPHEMERIS_DATA |
434 GnssSvFlagsV1_0::HAS_ALMANAC_DATA | GnssSvFlagsV1_0::HAS_CARRIER_FREQUENCY};
Yu-Han Yanga5098612019-02-08 16:22:07 -0800435 return svInfo;
436}
437
Sasha Kuznetsov768de572020-02-11 06:00:10 +0000438hidl_vec<GnssAntennaInfo> Utils::getMockAntennaInfos() {
439 GnssAntennaInfo mockAntennaInfo_1 = {
Yu-Han Yang703ac962021-07-20 16:47:37 -0700440 .carrierFrequencyMHz = kGpsL1FreqHz * 1e-6,
Sasha Kuznetsov768de572020-02-11 06:00:10 +0000441 .phaseCenterOffsetCoordinateMillimeters = Coord{.x = 1,
442 .xUncertainty = 0.1,
443 .y = 2,
444 .yUncertainty = 0.1,
445 .z = 3,
446 .zUncertainty = 0.1},
447 .phaseCenterVariationCorrectionMillimeters =
448 {
449 Row{hidl_vec<double>{1, -1, 5, -2, 3, -1}},
450 Row{hidl_vec<double>{-2, 3, 2, 0, 1, 2}},
451 Row{hidl_vec<double>{1, 3, 2, -1, -3, 5}},
452 },
453 .phaseCenterVariationCorrectionUncertaintyMillimeters =
454 {
455 Row{hidl_vec<double>{0.1, 0.2, 0.4, 0.1, 0.2, 0.3}},
456 Row{hidl_vec<double>{0.3, 0.2, 0.3, 0.6, 0.1, 0.1}},
457 Row{hidl_vec<double>{0.1, 0.1, 0.4, 0.2, 0.5, 0.3}},
458 },
459 .signalGainCorrectionDbi =
460 {
461 Row{hidl_vec<double>{2, -3, 1, -3, 0, -4}},
462 Row{hidl_vec<double>{1, 0, -4, 1, 3, -2}},
463 Row{hidl_vec<double>{3, -2, 0, -2, 3, 0}},
464 },
465 .signalGainCorrectionUncertaintyDbi =
466 {
467 Row{hidl_vec<double>{0.3, 0.1, 0.2, 0.6, 0.1, 0.3}},
468 Row{hidl_vec<double>{0.1, 0.1, 0.5, 0.2, 0.3, 0.1}},
469 Row{hidl_vec<double>{0.2, 0.4, 0.2, 0.1, 0.1, 0.2}},
470 },
471 };
472
473 GnssAntennaInfo mockAntennaInfo_2 = {
Yu-Han Yang703ac962021-07-20 16:47:37 -0700474 .carrierFrequencyMHz = kGpsL5FreqHz * 1e-6,
Sasha Kuznetsov768de572020-02-11 06:00:10 +0000475 .phaseCenterOffsetCoordinateMillimeters = Coord{.x = 5,
476 .xUncertainty = 0.1,
477 .y = 6,
478 .yUncertainty = 0.1,
479 .z = 7,
480 .zUncertainty = 0.1},
481 };
482
483 hidl_vec<GnssAntennaInfo> mockAntennaInfos = {
484 mockAntennaInfo_1,
485 mockAntennaInfo_2,
486 };
487 return mockAntennaInfos;
488}
489
Yu-Han Yanga5098612019-02-08 16:22:07 -0800490} // namespace common
491} // namespace gnss
492} // namespace hardware
493} // namespace android