#define LOG_TAG "Gnss" #include <android/hardware/gnss/1.0/types.h> #include <log/log.h> #include "Gnss.h" #include "GnssDebug.h" #include "GnssMeasurement.h" #include "Utils.h" namespace android { namespace hardware { namespace gnss { namespace V1_1 { namespace implementation { using ::android::hardware::gnss::common::Utils; using GnssSvFlags = IGnssCallback::GnssSvFlags; const uint32_t MIN_INTERVAL_MILLIS = 100; sp<::android::hardware::gnss::V1_1::IGnssCallback> Gnss::sGnssCallback = nullptr; Gnss::Gnss() : mMinIntervalMs(1000), mGnssConfiguration{new GnssConfiguration()} {} Gnss::~Gnss() { stop(); } // Methods from ::android::hardware::gnss::V1_0::IGnss follow. Return<bool> Gnss::setCallback(const sp<::android::hardware::gnss::V1_0::IGnssCallback>&) { // Mock handles only new callback (see setCallback1_1) coming from Android P+ return false; } Return<bool> Gnss::start() { if (mIsActive) { ALOGW("Gnss has started. Restarting..."); stop(); } mIsActive = true; mThread = std::thread([this]() { while (mIsActive == true) { auto svStatus = this->getMockSvStatus(); this->reportSvStatus(svStatus); auto location = Utils::getMockLocation(); this->reportLocation(location); std::this_thread::sleep_for(std::chrono::milliseconds(mMinIntervalMs)); } }); return true; } Return<bool> Gnss::stop() { mIsActive = false; if (mThread.joinable()) { mThread.join(); } return true; } Return<void> Gnss::cleanup() { // TODO implement return Void(); } Return<bool> Gnss::injectTime(int64_t, int64_t, int32_t) { // TODO implement return bool{}; } Return<bool> Gnss::injectLocation(double, double, float) { // TODO implement return bool{}; } Return<void> Gnss::deleteAidingData(::android::hardware::gnss::V1_0::IGnss::GnssAidingData) { return Void(); } Return<bool> Gnss::setPositionMode(::android::hardware::gnss::V1_0::IGnss::GnssPositionMode, ::android::hardware::gnss::V1_0::IGnss::GnssPositionRecurrence, uint32_t, uint32_t, uint32_t) { // TODO implement return bool{}; } Return<sp<::android::hardware::gnss::V1_0::IAGnssRil>> Gnss::getExtensionAGnssRil() { // TODO implement return ::android::sp<::android::hardware::gnss::V1_0::IAGnssRil>{}; } Return<sp<::android::hardware::gnss::V1_0::IGnssGeofencing>> Gnss::getExtensionGnssGeofencing() { // TODO implement return ::android::sp<::android::hardware::gnss::V1_0::IGnssGeofencing>{}; } Return<sp<::android::hardware::gnss::V1_0::IAGnss>> Gnss::getExtensionAGnss() { // TODO implement return ::android::sp<::android::hardware::gnss::V1_0::IAGnss>{}; } Return<sp<::android::hardware::gnss::V1_0::IGnssNi>> Gnss::getExtensionGnssNi() { // TODO implement return ::android::sp<::android::hardware::gnss::V1_0::IGnssNi>{}; } Return<sp<::android::hardware::gnss::V1_0::IGnssMeasurement>> Gnss::getExtensionGnssMeasurement() { // TODO implement return new GnssMeasurement(); } Return<sp<::android::hardware::gnss::V1_0::IGnssNavigationMessage>> Gnss::getExtensionGnssNavigationMessage() { // TODO implement return ::android::sp<::android::hardware::gnss::V1_0::IGnssNavigationMessage>{}; } Return<sp<::android::hardware::gnss::V1_0::IGnssXtra>> Gnss::getExtensionXtra() { // TODO implement return ::android::sp<::android::hardware::gnss::V1_0::IGnssXtra>{}; } Return<sp<::android::hardware::gnss::V1_0::IGnssConfiguration>> Gnss::getExtensionGnssConfiguration() { // TODO implement return new GnssConfiguration(); } Return<sp<::android::hardware::gnss::V1_0::IGnssDebug>> Gnss::getExtensionGnssDebug() { return new GnssDebug(); } Return<sp<::android::hardware::gnss::V1_0::IGnssBatching>> Gnss::getExtensionGnssBatching() { // TODO implement return ::android::sp<::android::hardware::gnss::V1_0::IGnssBatching>{}; } // Methods from ::android::hardware::gnss::V1_1::IGnss follow. Return<bool> Gnss::setCallback_1_1( const sp<::android::hardware::gnss::V1_1::IGnssCallback>& callback) { if (callback == nullptr) { ALOGE("%s: Null callback ignored", __func__); return false; } sGnssCallback = callback; uint32_t capabilities = 0x0; auto ret = sGnssCallback->gnssSetCapabilitesCb(capabilities); if (!ret.isOk()) { ALOGE("%s: Unable to invoke callback", __func__); } IGnssCallback::GnssSystemInfo gnssInfo = {.yearOfHw = 2018}; ret = sGnssCallback->gnssSetSystemInfoCb(gnssInfo); if (!ret.isOk()) { ALOGE("%s: Unable to invoke callback", __func__); } auto gnssName = "Google Mock GNSS Implementation v1.1"; ret = sGnssCallback->gnssNameCb(gnssName); if (!ret.isOk()) { ALOGE("%s: Unable to invoke callback", __func__); } return true; } Return<bool> Gnss::setPositionMode_1_1( ::android::hardware::gnss::V1_0::IGnss::GnssPositionMode, ::android::hardware::gnss::V1_0::IGnss::GnssPositionRecurrence, uint32_t minIntervalMs, uint32_t, uint32_t, bool) { mMinIntervalMs = (minIntervalMs < MIN_INTERVAL_MILLIS) ? MIN_INTERVAL_MILLIS : minIntervalMs; return true; } Return<sp<::android::hardware::gnss::V1_1::IGnssConfiguration>> Gnss::getExtensionGnssConfiguration_1_1() { return mGnssConfiguration; } Return<sp<::android::hardware::gnss::V1_1::IGnssMeasurement>> Gnss::getExtensionGnssMeasurement_1_1() { // TODO implement return new GnssMeasurement(); } Return<bool> Gnss::injectBestLocation(const GnssLocation&) { return true; } Return<GnssSvStatus> Gnss::getMockSvStatus() const { std::unique_lock<std::recursive_mutex> lock(mGnssConfiguration->getMutex()); GnssSvInfo mockGnssSvInfoList[] = { Utils::getSvInfo(3, GnssConstellationType::GPS, 32.5, 59.1, 166.5), Utils::getSvInfo(5, GnssConstellationType::GPS, 27.0, 29.0, 56.5), Utils::getSvInfo(17, GnssConstellationType::GPS, 30.5, 71.0, 77.0), Utils::getSvInfo(26, GnssConstellationType::GPS, 24.1, 28.0, 253.0), Utils::getSvInfo(5, GnssConstellationType::GLONASS, 20.5, 11.5, 116.0), Utils::getSvInfo(17, GnssConstellationType::GLONASS, 21.5, 28.5, 186.0), Utils::getSvInfo(18, GnssConstellationType::GLONASS, 28.3, 38.8, 69.0), Utils::getSvInfo(10, GnssConstellationType::GLONASS, 25.0, 66.0, 247.0)}; GnssSvStatus svStatus = {.numSvs = sizeof(mockGnssSvInfoList) / sizeof(GnssSvInfo)}; for (uint32_t i = 0; i < svStatus.numSvs; i++) { if (mGnssConfiguration->isBlacklisted(mockGnssSvInfoList[i])) { /** * Note well, this is a simple, mock emulation of not using a satellite by changing the * used bit. Simply blanking the used bit, as is done here, is *not* an acceptable * actual device implementation - actual devices *must not* use the satellite in the * position calculation, as specified in IGnssConfiguration.hal. */ mockGnssSvInfoList[i].svFlag &= ~static_cast<uint8_t>(IGnssCallback::GnssSvFlags::USED_IN_FIX); } svStatus.gnssSvList[i] = mockGnssSvInfoList[i]; } return svStatus; } Return<void> Gnss::reportLocation(const GnssLocation& location) const { std::unique_lock<std::mutex> lock(mMutex); if (sGnssCallback == nullptr) { ALOGE("%s: sGnssCallback is null.", __func__); return Void(); } sGnssCallback->gnssLocationCb(location); return Void(); } Return<void> Gnss::reportSvStatus(const GnssSvStatus& svStatus) const { std::unique_lock<std::mutex> lock(mMutex); if (sGnssCallback == nullptr) { ALOGE("%s: sGnssCallback is null.", __func__); return Void(); } sGnssCallback->gnssSvStatusCb(svStatus); return Void(); } } // namespace implementation } // namespace V1_1 } // namespace gnss } // namespace hardware } // namespace android