Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 76ff33b7 authored by Yuchen He's avatar Yuchen He Committed by Hao Chen
Browse files

Add parser to support CSV location data

Bug: 213225295
Test: launch_cvd -cpus 16 -memory_mb 16192  --start_gnss_proxy
--gnss_file_path=/google/data/rw/users/yu/yuchenhe/input.txt (Running blue
dot in Google Maps)

Almost a cherry-pick but changed the data type from AIDL GnssLocation to
the HIDL type, since there are no AIDL GnssLocation Type in SC-V2.

Merged-In: I572315888c2f57ce701e695acb03aa6b28787f31
Change-Id: I572315888c2f57ce701e695acb03aa6b28787f31
parent 4eb8cf8f
Loading
Loading
Loading
Loading
+1 −0
Original line number Diff line number Diff line
@@ -39,6 +39,7 @@ cc_library_static {
        "v2_1/GnssMeasurement.cpp",
        "v2_1/GnssMeasurementCorrections.cpp",
        "DeviceFileReader.cpp",
        "FixLocationParser.cpp",
        "GnssRawMeasurementParser.cpp",
        "GnssReplayUtils.cpp",
        "MockLocation.cpp",
+76 −0
Original line number Diff line number Diff line
/*
 * Copyright (C) 2022 The Android Open Source Project
 *
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 *      http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 */

#include "FixLocationParser.h"

#include <android/hardware/gnss/1.0/IGnss.h>

namespace android {
namespace hardware {
namespace gnss {
namespace common {

std::unique_ptr<V2_0::GnssLocation> FixLocationParser::getLocationFromInputStr(
        const std::string& locationStr) {
    /*
     * Fix,Provider,LatitudeDegrees,LongitudeDegrees,AltitudeMeters,SpeedMps,
     * AccuracyMeters,BearingDegrees,UnixTimeMillis,SpeedAccuracyMps,BearingAccuracyDegrees,
     * elapsedRealtimeNanos
     */
    if (locationStr.empty()) {
        return nullptr;
    }
    std::vector<std::string> locationStrRecords;
    ParseUtils::splitStr(locationStr, LINE_SEPARATOR, locationStrRecords);
    if (locationStrRecords.empty()) {
        return nullptr;
    }

    std::vector<std::string> locationValues;
    ParseUtils::splitStr(locationStrRecords[0], COMMA_SEPARATOR, locationValues);
    if (locationValues.size() < 12) {
        return nullptr;
    }
    V2_0::ElapsedRealtime elapsedRealtime = {
            .flags = V2_0::ElapsedRealtimeFlags::HAS_TIMESTAMP_NS |
                     V2_0::ElapsedRealtimeFlags::HAS_TIME_UNCERTAINTY_NS,
            .timestampNs = static_cast<uint64_t>(::android::elapsedRealtimeNano()),
            // This is an hardcoded value indicating a 1ms of uncertainty between the two clocks.
            // In an actual implementation provide an estimate of the synchronization uncertainty
            // or don't set the field.
            .timeUncertaintyNs = 1020400};

    V1_0::GnssLocation locationV1 = {
            .gnssLocationFlags = 0xFF,
            .latitudeDegrees = ParseUtils::tryParseDouble(locationValues[2], 0),
            .longitudeDegrees = ParseUtils::tryParseDouble(locationValues[3], 0),
            .altitudeMeters = ParseUtils::tryParseDouble(locationValues[4], 0),
            .speedMetersPerSec = ParseUtils::tryParsefloat(locationValues[5], 0),
            .bearingDegrees = ParseUtils::tryParsefloat(locationValues[7], 0),
            .horizontalAccuracyMeters = ParseUtils::tryParsefloat(locationValues[6], 0),
            .verticalAccuracyMeters = ParseUtils::tryParsefloat(locationValues[6], 0),
            .speedAccuracyMetersPerSecond = ParseUtils::tryParsefloat(locationValues[9], 0),
            .bearingAccuracyDegrees = ParseUtils::tryParsefloat(locationValues[10], 0),
            .timestamp = ParseUtils::tryParseLongLong(locationValues[8], 0)};

    V2_0::GnssLocation locationV2 = {.v1_0 = locationV1, .elapsedRealtime = elapsedRealtime};
    return std::make_unique<V2_0::GnssLocation>(locationV2);
}

}  // namespace common
}  // namespace gnss
}  // namespace hardware
}  // namespace android
+47 −0
Original line number Diff line number Diff line
/*
 * Copyright (C) 2022 The Android Open Source Project
 *
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 *      http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 */

#ifndef android_hardware_gnss_common_default_FixLocationParser_H_
#define android_hardware_gnss_common_default_FixLocationParser_H_

#include <android/hardware/gnss/2.0/IGnss.h>

#include <utils/SystemClock.h>
#include <string>
#include <vector>

#include <Constants.h>
#include <Utils.h>
#include <log/log.h>
#include "Constants.h"
#include "ParseUtils.h"

namespace android {
namespace hardware {
namespace gnss {
namespace common {

struct FixLocationParser {
  public:
    static std::unique_ptr<V2_0::GnssLocation> getLocationFromInputStr(const std::string& inputStr);
};

}  // namespace common
}  // namespace gnss
}  // namespace hardware
}  // namespace android

#endif  // android_hardware_gnss_common_default_FixLocationParser_H_