支持4g模块GPS功能 源码包以及测试工具.zip

/* * Copyright (C) 2016 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. */ #define LOG_TAG "GnssHAL_GnssInterface" #include <Gnss.h> #include <GnssUtils.h> #include <utils/SystemClock.h> namespace android { namespace hardware { namespace gnss { namespace V2_0 { namespace implementation { using ::android::hardware::gnss::measurement_corrections::V1_0::implementation:: GnssMeasurementCorrections; using ::android::hardware::gnss::visibility_control::V1_0::implementation::GnssVisibilityControl; sp<V2_0::IGnssCallback> Gnss::sGnssCallback_2_0 = nullptr; sp<V1_1::IGnssCallback> Gnss::sGnssCallback_1_1 = nullptr; std::vector<std::unique_ptr<ThreadFuncArgs>> Gnss::sThreadFuncArgsList; sp<V1_0::IGnssCallback> Gnss::sGnssCbIface = nullptr; bool Gnss::sInterfaceExists = false; bool Gnss::sWakelockHeldGnss = false; bool Gnss::sWakelockHeldFused = false; GpsCallbacks Gnss::sGnssCb = { .size = sizeof(GpsCallbacks), .location_cb = locationCb, .status_cb = statusCb, .sv_status_cb = gpsSvStatusCb, .nmea_cb = nmeaCb, .set_capabilities_cb = setCapabilitiesCb, .acquire_wakelock_cb = acquireWakelockCb, .release_wakelock_cb = releaseWakelockCb, .create_thread_cb = createThreadCb, .request_utc_time_cb = requestUtcTimeCb, .set_system_info_cb = setSystemInfoCb, .gnss_sv_status_cb = gnssSvStatusCb, }; uint32_t Gnss::sCapabilitiesCached = 0; uint16_t Gnss::sYearOfHwCached = 0; Gnss::Gnss(gps_device_t* gnssDevice) : mDeathRecipient(new GnssHidlDeathRecipient(this)) { /* Error out if an instance of the interface already exists. */ LOG_ALWAYS_FATAL_IF(sInterfaceExists); sInterfaceExists = true; if (gnssDevice == nullptr) { ALOGE("%s: Invalid device_t handle", __func__); return; } mGnssIface = gnssDevice->get_gps_interface(gnssDevice); } Gnss::~Gnss() { sInterfaceExists = false; sThreadFuncArgsList.clear(); } void Gnss::locationCb(GpsLocation* location) { if (sGnssCbIface == nullptr && sGnssCallback_1_1 == nullptr && sGnssCallback_2_0 == nullptr) { ALOGE("%s: GNSS Callback Interface configured incorrectly", __func__); return; } if (location == nullptr) { ALOGE("%s: Invalid location from GNSS HAL", __func__); return; } android::hardware::gnss::V1_0::GnssLocation gnssLocation_1_0 = V1_0::implementation::convertToGnssLocation(location); if(sGnssCallback_2_0 != nullptr) { //ALOGE("%s: ceshi is here0", __func__); const ElapsedRealtime timestamp = { .flags = ElapsedRealtimeFlags::HAS_TIMESTAMP_NS | ElapsedRealtimeFlags::HAS_TIME_UNCERTAINTY_NS, .timestampNs = static_cast<uint64_t>(::android::elapsedRealtimeNano()), .timeUncertaintyNs = 1000000}; V2_0::GnssLocation gnssLocation = {.v1_0 = gnssLocation_1_0, .elapsedRealtime = timestamp}; auto ret = sGnssCallback_2_0->gnssLocationCb_2_0(gnssLocation); if (!ret.isOk()) { ALOGE("%s: Unable to invoke callback", __func__); } } else if(sGnssCallback_1_1 != nullptr) { //ALOGE("%s: ceshi is here1", __func__); auto ret = sGnssCallback_1_1->gnssLocationCb(gnssLocation_1_0); if (!ret.isOk()) { ALOGE("%s: Unable to invoke callback", __func__); } } else if(sGnssCbIface != nullptr) { //ALOGE("%s: ceshi is here2", __func__); auto ret = sGnssCbIface->gnssLocationCb(gnssLocation_1_0); if (!ret.isOk()) { ALOGE("%s: Unable to invoke callback", __func__); } } } void Gnss::statusCb(GpsStatus* gnssStatus) { if (sGnssCbIface == nullptr && sGnssCallback_1_1 == nullptr && sGnssCallback_2_0 == nullptr) { ALOGE("%s: GNSS Callback Interface configured incorrectly", __func__); return; } if (gnssStatus == nullptr) { ALOGE("%s: Invalid GpsStatus from GNSS HAL", __func__); return; } IGnssCallback::GnssStatusValue status = static_cast<IGnssCallback::GnssStatusValue>(gnssStatus->status); if(sGnssCallback_2_0 != nullptr) { auto ret = sGnssCallback_2_0->gnssStatusCb(status); if (!ret.isOk()) { ALOGE("%s: Unable to invoke callback", __func__); } } else if(sGnssCallback_1_1 != nullptr) { auto ret = sGnssCallback_1_1->gnssStatusCb(status); if (!ret.isOk()) { ALOGE("%s: Unable to invoke callback", __func__); } } else if(sGnssCbIface != nullptr) { auto ret = sGnssCbIface->gnssStatusCb(status); if (!ret.isOk()) { ALOGE("%s: Unable to invoke callback", __func__); } } } void Gnss::gnssSvStatusCb(GnssSvStatus* status) { if (sGnssCbIface == nullptr && sGnssCallback_1_1 == nullptr && sGnssCallback_2_0 == nullptr) { ALOGE("%s: GNSS Callback Interface configured incorrectly", __func__); return; } if (status == nullptr) { ALOGE("Invalid status from GNSS HAL %s", __func__); return; } IGnssCallback::GnssSvStatus svStatus; svStatus.numSvs = status->num_svs; if (svStatus.numSvs > static_cast<uint32_t>(V1_0::GnssMax::SVS_COUNT)) { ALOGW("Too many satellites %u. Clamps to %d.", svStatus.numSvs, V1_0::GnssMax::SVS_COUNT); svStatus.numSvs = static_cast<uint32_t>(V1_0::GnssMax::SVS_COUNT); } for (size_t i = 0; i < svStatus.numSvs; i++) { auto svInfo = status->gnss_sv_list[i]; V1_0::IGnssCallback::GnssSvInfo gnssSvInfo = { .svid = svInfo.svid, .constellation = static_cast< android::hardware::gnss::V1_0::GnssConstellationType>( svInfo.constellation), .cN0Dbhz = svInfo.c_n0_dbhz, .elevationDegrees = svInfo.elevation, .azimuthDegrees = svInfo.azimuth, // Older chipsets do not provide carrier frequency, hence // HAS_CARRIER_FREQUENCY flag and the carrierFrequencyHz fields // are not set. So we are resetting both fields here. //.svFlag = static_cast<uint8_t>( // svInfo.flags &= ~(static_cast<uint8_t>( // V1_0::IGnssCallback::GnssSvFlags::HAS_CARRIER_FREQUENCY))), .svFlag = svInfo.flags, .carrierFrequencyHz = 1111*1e6F}; svStatus.gnssSvList[i] = gnssSvInfo; } if(sGnssCallback_2_0 != nullptr) { auto ret = sGnssCallback_2_0->gnssSvStatusCb(svStatus); if (!ret.isOk()) { ALOGE("%s: Unable to invoke callback", __func__); } } else if(sGnssCallback_1_1 != nullptr) { auto ret = sGnssCallback_1_1->gnssSvStatusCb(svStatus); if (!ret.isOk()) { ALOGE("%s: Unable to invoke callback", __func__); } } else if(sGnssCbIface != nullptr) { auto ret = sGnssCbIface->gnssSvStatusCb(svStatus); if (!ret.isOk()) { ALOGE("%s: Unable to invoke callback", __func__); } } } /* * This enum is used by gpsSvStatusCb() method below to convert GpsSvStatus * to GnssSvStatus for backward compatibility. It is only used by the default * implementation and is not part of the GNSS interface. */ enum SvidValues : uint16_t { GLONASS_SVID_OFFSET = 64, GLONASS_SVID_COUNT = 24, BEIDOU_SVID_OFFSET = 200, BEIDOU_SVID_COUNT = 35, SBAS_SVID_MIN = 33, SBAS_SVID_MAX = 64