| /* Copyright (c) 2017, 2019, The Linux Foundation. All rights reserved. |
| * |
| * Redistribution and use in source and binary forms, with or without |
| * modification, are permitted provided that the following conditions are |
| * met: |
| * * Redistributions of source code must retain the above copyright |
| * notice, this list of conditions and the following disclaimer. |
| * * Redistributions in binary form must reproduce the above |
| * copyright notice, this list of conditions and the following |
| * disclaimer in the documentation and/or other materials provided |
| * with the distribution. |
| * * Neither the name of The Linux Foundation, nor the names of its |
| * contributors may be used to endorse or promote products derived |
| * from this software without specific prior written permission. |
| * |
| * THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED |
| * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF |
| * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT |
| * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS |
| * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
| * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
| * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR |
| * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, |
| * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE |
| * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN |
| * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| * |
| */ |
| #define LOG_TAG "LocSvc_SystemStatus" |
| |
| #include <inttypes.h> |
| #include <string> |
| #include <stdlib.h> |
| #include <string.h> |
| #include <sys/time.h> |
| #include <pthread.h> |
| #include <loc_pla.h> |
| #include <log_util.h> |
| #include <loc_nmea.h> |
| #include <DataItemsFactoryProxy.h> |
| #include <SystemStatus.h> |
| #include <SystemStatusOsObserver.h> |
| #include <DataItemConcreteTypesBase.h> |
| |
| namespace loc_core |
| { |
| |
| /****************************************************************************** |
| SystemStatusNmeaBase - base class for all NMEA parsers |
| ******************************************************************************/ |
| class SystemStatusNmeaBase |
| { |
| protected: |
| std::vector<std::string> mField; |
| |
| SystemStatusNmeaBase(const char *str_in, uint32_t len_in) |
| { |
| // check size and talker |
| if (!loc_nmea_is_debug(str_in, len_in)) { |
| return; |
| } |
| |
| std::string parser(str_in); |
| std::string::size_type index = 0; |
| |
| // verify checksum field |
| index = parser.find("*"); |
| if (index == std::string::npos) { |
| return; |
| } |
| parser[index] = ','; |
| |
| // tokenize parser |
| while (1) { |
| std::string str; |
| index = parser.find(","); |
| if (index == std::string::npos) { |
| break; |
| } |
| str = parser.substr(0, index); |
| parser = parser.substr(index + 1); |
| mField.push_back(str); |
| } |
| } |
| |
| virtual ~SystemStatusNmeaBase() { } |
| |
| public: |
| static const uint32_t NMEA_MINSIZE = DEBUG_NMEA_MINSIZE; |
| static const uint32_t NMEA_MAXSIZE = DEBUG_NMEA_MAXSIZE; |
| }; |
| |
| /****************************************************************************** |
| SystemStatusPQWM1 |
| ******************************************************************************/ |
| class SystemStatusPQWM1 |
| { |
| public: |
| uint16_t mGpsWeek; // x1 |
| uint32_t mGpsTowMs; // x2 |
| uint8_t mTimeValid; // x3 |
| uint8_t mTimeSource; // x4 |
| int32_t mTimeUnc; // x5 |
| int32_t mClockFreqBias; // x6 |
| int32_t mClockFreqBiasUnc; // x7 |
| uint8_t mXoState; // x8 |
| int32_t mPgaGain; // x9 |
| uint32_t mGpsBpAmpI; // xA |
| uint32_t mGpsBpAmpQ; // xB |
| uint32_t mAdcI; // xC |
| uint32_t mAdcQ; // xD |
| uint32_t mJammerGps; // xE |
| uint32_t mJammerGlo; // xF |
| uint32_t mJammerBds; // x10 |
| uint32_t mJammerGal; // x11 |
| uint32_t mRecErrorRecovery; // x12 |
| double mAgcGps; // x13 |
| double mAgcGlo; // x14 |
| double mAgcBds; // x15 |
| double mAgcGal; // x16 |
| int32_t mLeapSeconds;// x17 |
| int32_t mLeapSecUnc; // x18 |
| uint32_t mGloBpAmpI; // x19 |
| uint32_t mGloBpAmpQ; // x1A |
| uint32_t mBdsBpAmpI; // x1B |
| uint32_t mBdsBpAmpQ; // x1C |
| uint32_t mGalBpAmpI; // x1D |
| uint32_t mGalBpAmpQ; // x1E |
| uint64_t mTimeUncNs; // x1F |
| }; |
| |
| // parser |
| class SystemStatusPQWM1parser : public SystemStatusNmeaBase |
| { |
| private: |
| enum |
| { |
| eTalker = 0, |
| eGpsWeek = 1, |
| eGpsTowMs = 2, |
| eTimeValid = 3, |
| eTimeSource = 4, |
| eTimeUnc = 5, |
| eClockFreqBias = 6, |
| eClockFreqBiasUnc = 7, |
| eXoState = 8, |
| ePgaGain = 9, |
| eGpsBpAmpI = 10, |
| eGpsBpAmpQ = 11, |
| eAdcI = 12, |
| eAdcQ = 13, |
| eJammerGps = 14, |
| eJammerGlo = 15, |
| eJammerBds = 16, |
| eJammerGal = 17, |
| eRecErrorRecovery = 18, |
| eAgcGps = 19, |
| eAgcGlo = 20, |
| eAgcBds = 21, |
| eAgcGal = 22, |
| eMax0 = eAgcGal, |
| eLeapSeconds = 23, |
| eLeapSecUnc = 24, |
| eGloBpAmpI = 25, |
| eGloBpAmpQ = 26, |
| eBdsBpAmpI = 27, |
| eBdsBpAmpQ = 28, |
| eGalBpAmpI = 29, |
| eGalBpAmpQ = 30, |
| eTimeUncNs = 31, |
| eMax |
| }; |
| SystemStatusPQWM1 mM1; |
| |
| public: |
| inline uint16_t getGpsWeek() { return mM1.mGpsWeek; } |
| inline uint32_t getGpsTowMs() { return mM1.mGpsTowMs; } |
| inline uint8_t getTimeValid() { return mM1.mTimeValid; } |
| inline uint8_t getTimeSource() { return mM1.mTimeSource; } |
| inline int32_t getTimeUnc() { return mM1.mTimeUnc; } |
| inline int32_t getClockFreqBias() { return mM1.mClockFreqBias; } |
| inline int32_t getClockFreqBiasUnc() { return mM1.mClockFreqBiasUnc; } |
| inline uint8_t getXoState() { return mM1.mXoState;} |
| inline int32_t getPgaGain() { return mM1.mPgaGain; } |
| inline uint32_t getGpsBpAmpI() { return mM1.mGpsBpAmpI; } |
| inline uint32_t getGpsBpAmpQ() { return mM1.mGpsBpAmpQ; } |
| inline uint32_t getAdcI() { return mM1.mAdcI; } |
| inline uint32_t getAdcQ() { return mM1.mAdcQ; } |
| inline uint32_t getJammerGps() { return mM1.mJammerGps; } |
| inline uint32_t getJammerGlo() { return mM1.mJammerGlo; } |
| inline uint32_t getJammerBds() { return mM1.mJammerBds; } |
| inline uint32_t getJammerGal() { return mM1.mJammerGal; } |
| inline uint32_t getAgcGps() { return mM1.mAgcGps; } |
| inline uint32_t getAgcGlo() { return mM1.mAgcGlo; } |
| inline uint32_t getAgcBds() { return mM1.mAgcBds; } |
| inline uint32_t getAgcGal() { return mM1.mAgcGal; } |
| inline uint32_t getRecErrorRecovery() { return mM1.mRecErrorRecovery; } |
| inline int32_t getLeapSeconds(){ return mM1.mLeapSeconds; } |
| inline int32_t getLeapSecUnc() { return mM1.mLeapSecUnc; } |
| inline uint32_t getGloBpAmpI() { return mM1.mGloBpAmpI; } |
| inline uint32_t getGloBpAmpQ() { return mM1.mGloBpAmpQ; } |
| inline uint32_t getBdsBpAmpI() { return mM1.mBdsBpAmpI; } |
| inline uint32_t getBdsBpAmpQ() { return mM1.mBdsBpAmpQ; } |
| inline uint32_t getGalBpAmpI() { return mM1.mGalBpAmpI; } |
| inline uint32_t getGalBpAmpQ() { return mM1.mGalBpAmpQ; } |
| inline uint64_t getTimeUncNs() { return mM1.mTimeUncNs; } |
| |
| SystemStatusPQWM1parser(const char *str_in, uint32_t len_in) |
| : SystemStatusNmeaBase(str_in, len_in) |
| { |
| memset(&mM1, 0, sizeof(mM1)); |
| if (mField.size() <= eMax0) { |
| LOC_LOGE("PQWM1parser - invalid size=%zu", mField.size()); |
| mM1.mTimeValid = 0; |
| return; |
| } |
| mM1.mGpsWeek = atoi(mField[eGpsWeek].c_str()); |
| mM1.mGpsTowMs = atoi(mField[eGpsTowMs].c_str()); |
| mM1.mTimeValid = atoi(mField[eTimeValid].c_str()); |
| mM1.mTimeSource = atoi(mField[eTimeSource].c_str()); |
| mM1.mTimeUnc = atoi(mField[eTimeUnc].c_str()); |
| mM1.mClockFreqBias = atoi(mField[eClockFreqBias].c_str()); |
| mM1.mClockFreqBiasUnc = atoi(mField[eClockFreqBiasUnc].c_str()); |
| mM1.mXoState = atoi(mField[eXoState].c_str()); |
| mM1.mPgaGain = atoi(mField[ePgaGain].c_str()); |
| mM1.mGpsBpAmpI = atoi(mField[eGpsBpAmpI].c_str()); |
| mM1.mGpsBpAmpQ = atoi(mField[eGpsBpAmpQ].c_str()); |
| mM1.mAdcI = atoi(mField[eAdcI].c_str()); |
| mM1.mAdcQ = atoi(mField[eAdcQ].c_str()); |
| mM1.mJammerGps = atoi(mField[eJammerGps].c_str()); |
| mM1.mJammerGlo = atoi(mField[eJammerGlo].c_str()); |
| mM1.mJammerBds = atoi(mField[eJammerBds].c_str()); |
| mM1.mJammerGal = atoi(mField[eJammerGal].c_str()); |
| mM1.mRecErrorRecovery = atoi(mField[eRecErrorRecovery].c_str()); |
| mM1.mAgcGps = atof(mField[eAgcGps].c_str()); |
| mM1.mAgcGlo = atof(mField[eAgcGlo].c_str()); |
| mM1.mAgcBds = atof(mField[eAgcBds].c_str()); |
| mM1.mAgcGal = atof(mField[eAgcGal].c_str()); |
| if (mField.size() > eLeapSecUnc) { |
| mM1.mLeapSeconds = atoi(mField[eLeapSeconds].c_str()); |
| mM1.mLeapSecUnc = atoi(mField[eLeapSecUnc].c_str()); |
| } |
| if (mField.size() > eGalBpAmpQ) { |
| mM1.mGloBpAmpI = atoi(mField[eGloBpAmpI].c_str()); |
| mM1.mGloBpAmpQ = atoi(mField[eGloBpAmpQ].c_str()); |
| mM1.mBdsBpAmpI = atoi(mField[eBdsBpAmpI].c_str()); |
| mM1.mBdsBpAmpQ = atoi(mField[eBdsBpAmpQ].c_str()); |
| mM1.mGalBpAmpI = atoi(mField[eGalBpAmpI].c_str()); |
| mM1.mGalBpAmpQ = atoi(mField[eGalBpAmpQ].c_str()); |
| } |
| if (mField.size() > eTimeUncNs) { |
| mM1.mTimeUncNs = strtoull(mField[eTimeUncNs].c_str(), nullptr, 10); |
| } |
| } |
| |
| inline SystemStatusPQWM1& get() { return mM1;} //getparser |
| }; |
| |
| /****************************************************************************** |
| SystemStatusPQWP1 |
| ******************************************************************************/ |
| class SystemStatusPQWP1 |
| { |
| public: |
| uint8_t mEpiValidity; // x4 |
| float mEpiLat; // x5 |
| float mEpiLon; // x6 |
| float mEpiAlt; // x7 |
| float mEpiHepe; // x8 |
| float mEpiAltUnc; // x9 |
| uint8_t mEpiSrc; // x10 |
| }; |
| |
| class SystemStatusPQWP1parser : public SystemStatusNmeaBase |
| { |
| private: |
| enum |
| { |
| eTalker = 0, |
| eUtcTime = 1, |
| eEpiValidity = 2, |
| eEpiLat = 3, |
| eEpiLon = 4, |
| eEpiAlt = 5, |
| eEpiHepe = 6, |
| eEpiAltUnc = 7, |
| eEpiSrc = 8, |
| eMax |
| }; |
| SystemStatusPQWP1 mP1; |
| |
| public: |
| inline uint8_t getEpiValidity() { return mP1.mEpiValidity; } |
| inline float getEpiLat() { return mP1.mEpiLat; } |
| inline float getEpiLon() { return mP1.mEpiLon; } |
| inline float getEpiAlt() { return mP1.mEpiAlt; } |
| inline float getEpiHepe() { return mP1.mEpiHepe; } |
| inline float getEpiAltUnc() { return mP1.mEpiAltUnc; } |
| inline uint8_t getEpiSrc() { return mP1.mEpiSrc; } |
| |
| SystemStatusPQWP1parser(const char *str_in, uint32_t len_in) |
| : SystemStatusNmeaBase(str_in, len_in) |
| { |
| if (mField.size() < eMax) { |
| return; |
| } |
| memset(&mP1, 0, sizeof(mP1)); |
| mP1.mEpiValidity = strtol(mField[eEpiValidity].c_str(), NULL, 16); |
| mP1.mEpiLat = atof(mField[eEpiLat].c_str()); |
| mP1.mEpiLon = atof(mField[eEpiLon].c_str()); |
| mP1.mEpiAlt = atof(mField[eEpiAlt].c_str()); |
| mP1.mEpiHepe = atoi(mField[eEpiHepe].c_str()); |
| mP1.mEpiAltUnc = atof(mField[eEpiAltUnc].c_str()); |
| mP1.mEpiSrc = atoi(mField[eEpiSrc].c_str()); |
| } |
| |
| inline SystemStatusPQWP1& get() { return mP1;} |
| }; |
| |
| /****************************************************************************** |
| SystemStatusPQWP2 |
| ******************************************************************************/ |
| class SystemStatusPQWP2 |
| { |
| public: |
| float mBestLat; // x4 |
| float mBestLon; // x5 |
| float mBestAlt; // x6 |
| float mBestHepe; // x7 |
| float mBestAltUnc; // x8 |
| }; |
| |
| class SystemStatusPQWP2parser : public SystemStatusNmeaBase |
| { |
| private: |
| enum |
| { |
| eTalker = 0, |
| eUtcTime = 1, |
| eBestLat = 2, |
| eBestLon = 3, |
| eBestAlt = 4, |
| eBestHepe = 5, |
| eBestAltUnc = 6, |
| eMax |
| }; |
| SystemStatusPQWP2 mP2; |
| |
| public: |
| inline float getBestLat() { return mP2.mBestLat; } |
| inline float getBestLon() { return mP2.mBestLon; } |
| inline float getBestAlt() { return mP2.mBestAlt; } |
| inline float getBestHepe() { return mP2.mBestHepe; } |
| inline float getBestAltUnc() { return mP2.mBestAltUnc; } |
| |
| SystemStatusPQWP2parser(const char *str_in, uint32_t len_in) |
| : SystemStatusNmeaBase(str_in, len_in) |
| { |
| if (mField.size() < eMax) { |
| return; |
| } |
| memset(&mP2, 0, sizeof(mP2)); |
| mP2.mBestLat = atof(mField[eBestLat].c_str()); |
| mP2.mBestLon = atof(mField[eBestLon].c_str()); |
| mP2.mBestAlt = atof(mField[eBestAlt].c_str()); |
| mP2.mBestHepe = atof(mField[eBestHepe].c_str()); |
| mP2.mBestAltUnc = atof(mField[eBestAltUnc].c_str()); |
| } |
| |
| inline SystemStatusPQWP2& get() { return mP2;} |
| }; |
| |
| /****************************************************************************** |
| SystemStatusPQWP3 |
| ******************************************************************************/ |
| class SystemStatusPQWP3 |
| { |
| public: |
| uint8_t mXtraValidMask; |
| uint32_t mGpsXtraAge; |
| uint32_t mGloXtraAge; |
| uint32_t mBdsXtraAge; |
| uint32_t mGalXtraAge; |
| uint32_t mQzssXtraAge; |
| uint32_t mNavicXtraAge; |
| uint32_t mGpsXtraValid; |
| uint32_t mGloXtraValid; |
| uint64_t mBdsXtraValid; |
| uint64_t mGalXtraValid; |
| uint8_t mQzssXtraValid; |
| uint32_t mNavicXtraValid; |
| }; |
| |
| class SystemStatusPQWP3parser : public SystemStatusNmeaBase |
| { |
| private: |
| // todo: update for navic once available |
| enum |
| { |
| eTalker = 0, |
| eUtcTime = 1, |
| eXtraValidMask = 2, |
| eGpsXtraAge = 3, |
| eGloXtraAge = 4, |
| eBdsXtraAge = 5, |
| eGalXtraAge = 6, |
| eQzssXtraAge = 7, |
| eGpsXtraValid = 8, |
| eGloXtraValid = 9, |
| eBdsXtraValid = 10, |
| eGalXtraValid = 11, |
| eQzssXtraValid = 12, |
| eMax |
| }; |
| SystemStatusPQWP3 mP3; |
| |
| public: |
| inline uint8_t getXtraValid() { return mP3.mXtraValidMask; } |
| inline uint32_t getGpsXtraAge() { return mP3.mGpsXtraAge; } |
| inline uint32_t getGloXtraAge() { return mP3.mGloXtraAge; } |
| inline uint32_t getBdsXtraAge() { return mP3.mBdsXtraAge; } |
| inline uint32_t getGalXtraAge() { return mP3.mGalXtraAge; } |
| inline uint32_t getQzssXtraAge() { return mP3.mQzssXtraAge; } |
| inline uint32_t getNavicXtraAge() { return mP3.mNavicXtraAge; } |
| inline uint32_t getGpsXtraValid() { return mP3.mGpsXtraValid; } |
| inline uint32_t getGloXtraValid() { return mP3.mGloXtraValid; } |
| inline uint64_t getBdsXtraValid() { return mP3.mBdsXtraValid; } |
| inline uint64_t getGalXtraValid() { return mP3.mGalXtraValid; } |
| inline uint8_t getQzssXtraValid() { return mP3.mQzssXtraValid; } |
| inline uint32_t getNavicXtraValid() { return mP3.mNavicXtraValid; } |
| |
| SystemStatusPQWP3parser(const char *str_in, uint32_t len_in) |
| : SystemStatusNmeaBase(str_in, len_in) |
| { |
| if (mField.size() < eMax) { |
| return; |
| } |
| memset(&mP3, 0, sizeof(mP3)); |
| // todo: update for navic once available |
| mP3.mXtraValidMask = strtol(mField[eXtraValidMask].c_str(), NULL, 16); |
| mP3.mGpsXtraAge = atoi(mField[eGpsXtraAge].c_str()); |
| mP3.mGloXtraAge = atoi(mField[eGloXtraAge].c_str()); |
| mP3.mBdsXtraAge = atoi(mField[eBdsXtraAge].c_str()); |
| mP3.mGalXtraAge = atoi(mField[eGalXtraAge].c_str()); |
| mP3.mQzssXtraAge = atoi(mField[eQzssXtraAge].c_str()); |
| mP3.mGpsXtraValid = strtol(mField[eGpsXtraValid].c_str(), NULL, 16); |
| mP3.mGloXtraValid = strtol(mField[eGloXtraValid].c_str(), NULL, 16); |
| mP3.mBdsXtraValid = strtol(mField[eBdsXtraValid].c_str(), NULL, 16); |
| mP3.mGalXtraValid = strtol(mField[eGalXtraValid].c_str(), NULL, 16); |
| mP3.mQzssXtraValid = strtol(mField[eQzssXtraValid].c_str(), NULL, 16); |
| } |
| |
| inline SystemStatusPQWP3& get() { return mP3;} |
| }; |
| |
| /****************************************************************************** |
| SystemStatusPQWP4 |
| ******************************************************************************/ |
| class SystemStatusPQWP4 |
| { |
| public: |
| uint32_t mGpsEpheValid; |
| uint32_t mGloEpheValid; |
| uint64_t mBdsEpheValid; |
| uint64_t mGalEpheValid; |
| uint8_t mQzssEpheValid; |
| }; |
| |
| class SystemStatusPQWP4parser : public SystemStatusNmeaBase |
| { |
| private: |
| enum |
| { |
| eTalker = 0, |
| eUtcTime = 1, |
| eGpsEpheValid = 2, |
| eGloEpheValid = 3, |
| eBdsEpheValid = 4, |
| eGalEpheValid = 5, |
| eQzssEpheValid = 6, |
| eMax |
| }; |
| SystemStatusPQWP4 mP4; |
| |
| public: |
| inline uint32_t getGpsEpheValid() { return mP4.mGpsEpheValid; } |
| inline uint32_t getGloEpheValid() { return mP4.mGloEpheValid; } |
| inline uint64_t getBdsEpheValid() { return mP4.mBdsEpheValid; } |
| inline uint64_t getGalEpheValid() { return mP4.mGalEpheValid; } |
| inline uint8_t getQzssEpheValid() { return mP4.mQzssEpheValid; } |
| |
| SystemStatusPQWP4parser(const char *str_in, uint32_t len_in) |
| : SystemStatusNmeaBase(str_in, len_in) |
| { |
| if (mField.size() < eMax) { |
| return; |
| } |
| memset(&mP4, 0, sizeof(mP4)); |
| mP4.mGpsEpheValid = strtol(mField[eGpsEpheValid].c_str(), NULL, 16); |
| mP4.mGloEpheValid = strtol(mField[eGloEpheValid].c_str(), NULL, 16); |
| mP4.mBdsEpheValid = strtol(mField[eBdsEpheValid].c_str(), NULL, 16); |
| mP4.mGalEpheValid = strtol(mField[eGalEpheValid].c_str(), NULL, 16); |
| mP4.mQzssEpheValid = strtol(mField[eQzssEpheValid].c_str(), NULL, 16); |
| } |
| |
| inline SystemStatusPQWP4& get() { return mP4;} |
| }; |
| |
| /****************************************************************************** |
| SystemStatusPQWP5 |
| ******************************************************************************/ |
| class SystemStatusPQWP5 |
| { |
| public: |
| uint32_t mGpsUnknownMask; |
| uint32_t mGloUnknownMask; |
| uint64_t mBdsUnknownMask; |
| uint64_t mGalUnknownMask; |
| uint8_t mQzssUnknownMask; |
| uint32_t mNavicUnknownMask; |
| uint32_t mGpsGoodMask; |
| uint32_t mGloGoodMask; |
| uint64_t mBdsGoodMask; |
| uint64_t mGalGoodMask; |
| uint8_t mQzssGoodMask; |
| uint32_t mNavicGoodMask; |
| uint32_t mGpsBadMask; |
| uint32_t mGloBadMask; |
| uint64_t mBdsBadMask; |
| uint64_t mGalBadMask; |
| uint8_t mQzssBadMask; |
| uint32_t mNavicBadMask; |
| }; |
| |
| class SystemStatusPQWP5parser : public SystemStatusNmeaBase |
| { |
| private: |
| // todo: update for navic once available |
| enum |
| { |
| eTalker = 0, |
| eUtcTime = 1, |
| eGpsUnknownMask = 2, |
| eGloUnknownMask = 3, |
| eBdsUnknownMask = 4, |
| eGalUnknownMask = 5, |
| eQzssUnknownMask = 6, |
| eGpsGoodMask = 7, |
| eGloGoodMask = 8, |
| eBdsGoodMask = 9, |
| eGalGoodMask = 10, |
| eQzssGoodMask = 11, |
| eGpsBadMask = 12, |
| eGloBadMask = 13, |
| eBdsBadMask = 14, |
| eGalBadMask = 15, |
| eQzssBadMask = 16, |
| eMax |
| }; |
| SystemStatusPQWP5 mP5; |
| |
| public: |
| inline uint32_t getGpsUnknownMask() { return mP5.mGpsUnknownMask; } |
| inline uint32_t getGloUnknownMask() { return mP5.mGloUnknownMask; } |
| inline uint64_t getBdsUnknownMask() { return mP5.mBdsUnknownMask; } |
| inline uint64_t getGalUnknownMask() { return mP5.mGalUnknownMask; } |
| inline uint8_t getQzssUnknownMask() { return mP5.mQzssUnknownMask; } |
| inline uint32_t getNavicUnknownMask() { return mP5.mNavicUnknownMask; } |
| inline uint32_t getGpsGoodMask() { return mP5.mGpsGoodMask; } |
| inline uint32_t getGloGoodMask() { return mP5.mGloGoodMask; } |
| inline uint64_t getBdsGoodMask() { return mP5.mBdsGoodMask; } |
| inline uint64_t getGalGoodMask() { return mP5.mGalGoodMask; } |
| inline uint8_t getQzssGoodMask() { return mP5.mQzssGoodMask; } |
| inline uint32_t getNavicGoodMask() { return mP5.mNavicGoodMask; } |
| inline uint32_t getGpsBadMask() { return mP5.mGpsBadMask; } |
| inline uint32_t getGloBadMask() { return mP5.mGloBadMask; } |
| inline uint64_t getBdsBadMask() { return mP5.mBdsBadMask; } |
| inline uint64_t getGalBadMask() { return mP5.mGalBadMask; } |
| inline uint8_t getQzssBadMask() { return mP5.mQzssBadMask; } |
| inline uint32_t getNavicBadMask() { return mP5.mNavicBadMask; } |
| |
| SystemStatusPQWP5parser(const char *str_in, uint32_t len_in) |
| : SystemStatusNmeaBase(str_in, len_in) |
| { |
| if (mField.size() < eMax) { |
| return; |
| } |
| memset(&mP5, 0, sizeof(mP5)); |
| // todo: update for navic once available |
| mP5.mGpsUnknownMask = strtol(mField[eGpsUnknownMask].c_str(), NULL, 16); |
| mP5.mGloUnknownMask = strtol(mField[eGloUnknownMask].c_str(), NULL, 16); |
| mP5.mBdsUnknownMask = strtol(mField[eBdsUnknownMask].c_str(), NULL, 16); |
| mP5.mGalUnknownMask = strtol(mField[eGalUnknownMask].c_str(), NULL, 16); |
| mP5.mQzssUnknownMask = strtol(mField[eQzssUnknownMask].c_str(), NULL, 16); |
| mP5.mGpsGoodMask = strtol(mField[eGpsGoodMask].c_str(), NULL, 16); |
| mP5.mGloGoodMask = strtol(mField[eGloGoodMask].c_str(), NULL, 16); |
| mP5.mBdsGoodMask = strtol(mField[eBdsGoodMask].c_str(), NULL, 16); |
| mP5.mGalGoodMask = strtol(mField[eGalGoodMask].c_str(), NULL, 16); |
| mP5.mQzssGoodMask = strtol(mField[eQzssGoodMask].c_str(), NULL, 16); |
| mP5.mGpsBadMask = strtol(mField[eGpsBadMask].c_str(), NULL, 16); |
| mP5.mGloBadMask = strtol(mField[eGloBadMask].c_str(), NULL, 16); |
| mP5.mBdsBadMask = strtol(mField[eBdsBadMask].c_str(), NULL, 16); |
| mP5.mGalBadMask = strtol(mField[eGalBadMask].c_str(), NULL, 16); |
| mP5.mQzssBadMask = strtol(mField[eQzssBadMask].c_str(), NULL, 16); |
| } |
| |
| inline SystemStatusPQWP5& get() { return mP5;} |
| }; |
| |
| /****************************************************************************** |
| SystemStatusPQWP6parser |
| ******************************************************************************/ |
| class SystemStatusPQWP6 |
| { |
| public: |
| uint32_t mFixInfoMask; |
| }; |
| |
| class SystemStatusPQWP6parser : public SystemStatusNmeaBase |
| { |
| private: |
| enum |
| { |
| eTalker = 0, |
| eUtcTime = 1, |
| eFixInfoMask = 2, |
| eMax |
| }; |
| SystemStatusPQWP6 mP6; |
| |
| public: |
| inline uint32_t getFixInfoMask() { return mP6.mFixInfoMask; } |
| |
| SystemStatusPQWP6parser(const char *str_in, uint32_t len_in) |
| : SystemStatusNmeaBase(str_in, len_in) |
| { |
| if (mField.size() < eMax) { |
| return; |
| } |
| memset(&mP6, 0, sizeof(mP6)); |
| mP6.mFixInfoMask = strtol(mField[eFixInfoMask].c_str(), NULL, 16); |
| } |
| |
| inline SystemStatusPQWP6& get() { return mP6;} |
| }; |
| |
| /****************************************************************************** |
| SystemStatusPQWP7parser |
| ******************************************************************************/ |
| class SystemStatusPQWP7 |
| { |
| public: |
| SystemStatusNav mNav[SV_ALL_NUM]; |
| }; |
| |
| class SystemStatusPQWP7parser : public SystemStatusNmeaBase |
| { |
| private: |
| enum |
| { |
| eTalker = 0, |
| eUtcTime = 1, |
| eMin = 2 + SV_ALL_NUM_MIN*3, |
| eMax = 2 + SV_ALL_NUM*3 |
| }; |
| SystemStatusPQWP7 mP7; |
| |
| public: |
| SystemStatusPQWP7parser(const char *str_in, uint32_t len_in) |
| : SystemStatusNmeaBase(str_in, len_in) |
| { |
| uint32_t svLimit = SV_ALL_NUM; |
| if (mField.size() < eMin) { |
| LOC_LOGE("PQWP7parser - invalid size=%zu", mField.size()); |
| return; |
| } |
| if (mField.size() < eMax) { |
| // Try reducing limit, accounting for possibly missing NAVIC support |
| svLimit = SV_ALL_NUM_MIN; |
| } |
| |
| memset(mP7.mNav, 0, sizeof(mP7.mNav)); |
| for (uint32_t i=0; i<svLimit; i++) { |
| mP7.mNav[i].mType = GnssEphemerisType(atoi(mField[i*3+2].c_str())); |
| mP7.mNav[i].mSource = GnssEphemerisSource(atoi(mField[i*3+3].c_str())); |
| mP7.mNav[i].mAgeSec = atoi(mField[i*3+4].c_str()); |
| } |
| } |
| |
| inline SystemStatusPQWP7& get() { return mP7;} |
| }; |
| |
| /****************************************************************************** |
| SystemStatusPQWS1parser |
| ******************************************************************************/ |
| class SystemStatusPQWS1 |
| { |
| public: |
| uint32_t mFixInfoMask; |
| uint32_t mHepeLimit; |
| }; |
| |
| class SystemStatusPQWS1parser : public SystemStatusNmeaBase |
| { |
| private: |
| enum |
| { |
| eTalker = 0, |
| eUtcTime = 1, |
| eFixInfoMask = 2, |
| eHepeLimit = 3, |
| eMax |
| }; |
| SystemStatusPQWS1 mS1; |
| |
| public: |
| inline uint16_t getFixInfoMask() { return mS1.mFixInfoMask; } |
| inline uint32_t getHepeLimit() { return mS1.mHepeLimit; } |
| |
| SystemStatusPQWS1parser(const char *str_in, uint32_t len_in) |
| : SystemStatusNmeaBase(str_in, len_in) |
| { |
| if (mField.size() < eMax) { |
| return; |
| } |
| memset(&mS1, 0, sizeof(mS1)); |
| mS1.mFixInfoMask = atoi(mField[eFixInfoMask].c_str()); |
| mS1.mHepeLimit = atoi(mField[eHepeLimit].c_str()); |
| } |
| |
| inline SystemStatusPQWS1& get() { return mS1;} |
| }; |
| |
| /****************************************************************************** |
| SystemStatusTimeAndClock |
| ******************************************************************************/ |
| SystemStatusTimeAndClock::SystemStatusTimeAndClock(const SystemStatusPQWM1& nmea) : |
| mGpsWeek(nmea.mGpsWeek), |
| mGpsTowMs(nmea.mGpsTowMs), |
| mTimeValid(nmea.mTimeValid), |
| mTimeSource(nmea.mTimeSource), |
| mTimeUnc(nmea.mTimeUnc), |
| mClockFreqBias(nmea.mClockFreqBias), |
| mClockFreqBiasUnc(nmea.mClockFreqBiasUnc), |
| mLeapSeconds(nmea.mLeapSeconds), |
| mLeapSecUnc(nmea.mLeapSecUnc), |
| mTimeUncNs(nmea.mTimeUncNs) |
| { |
| } |
| |
| bool SystemStatusTimeAndClock::equals(const SystemStatusTimeAndClock& peer) |
| { |
| if ((mGpsWeek != peer.mGpsWeek) || |
| (mGpsTowMs != peer.mGpsTowMs) || |
| (mTimeValid != peer.mTimeValid) || |
| (mTimeSource != peer.mTimeSource) || |
| (mTimeUnc != peer.mTimeUnc) || |
| (mClockFreqBias != peer.mClockFreqBias) || |
| (mClockFreqBiasUnc != peer.mClockFreqBiasUnc) || |
| (mLeapSeconds != peer.mLeapSeconds) || |
| (mLeapSecUnc != peer.mLeapSecUnc) || |
| (mTimeUncNs != peer.mTimeUncNs)) { |
| return false; |
| } |
| return true; |
| } |
| |
| void SystemStatusTimeAndClock::dump() |
| { |
| LOC_LOGV("TimeAndClock: u=%ld:%ld g=%d:%d v=%d ts=%d tu=%d b=%d bu=%d ls=%d lu=%d un=%" PRIu64, |
| mUtcTime.tv_sec, mUtcTime.tv_nsec, |
| mGpsWeek, |
| mGpsTowMs, |
| mTimeValid, |
| mTimeSource, |
| mTimeUnc, |
| mClockFreqBias, |
| mClockFreqBiasUnc, |
| mLeapSeconds, |
| mLeapSecUnc, |
| mTimeUncNs); |
| return; |
| } |
| |
| /****************************************************************************** |
| SystemStatusXoState |
| ******************************************************************************/ |
| SystemStatusXoState::SystemStatusXoState(const SystemStatusPQWM1& nmea) : |
| mXoState(nmea.mXoState) |
| { |
| } |
| |
| bool SystemStatusXoState::equals(const SystemStatusXoState& peer) |
| { |
| if (mXoState != peer.mXoState) { |
| return false; |
| } |
| return true; |
| } |
| |
| void SystemStatusXoState::dump() |
| { |
| LOC_LOGV("XoState: u=%ld:%ld x=%d", |
| mUtcTime.tv_sec, mUtcTime.tv_nsec, |
| mXoState); |
| return; |
| } |
| |
| /****************************************************************************** |
| SystemStatusRfAndParams |
| ******************************************************************************/ |
| SystemStatusRfAndParams::SystemStatusRfAndParams(const SystemStatusPQWM1& nmea) : |
| mPgaGain(nmea.mPgaGain), |
| mGpsBpAmpI(nmea.mGpsBpAmpI), |
| mGpsBpAmpQ(nmea.mGpsBpAmpQ), |
| mAdcI(nmea.mAdcI), |
| mAdcQ(nmea.mAdcQ), |
| mJammerGps(nmea.mJammerGps), |
| mJammerGlo(nmea.mJammerGlo), |
| mJammerBds(nmea.mJammerBds), |
| mJammerGal(nmea.mJammerGal), |
| mAgcGps(nmea.mAgcGps), |
| mAgcGlo(nmea.mAgcGlo), |
| mAgcBds(nmea.mAgcBds), |
| mAgcGal(nmea.mAgcGal), |
| mGloBpAmpI(nmea.mGloBpAmpI), |
| mGloBpAmpQ(nmea.mGloBpAmpQ), |
| mBdsBpAmpI(nmea.mBdsBpAmpI), |
| mBdsBpAmpQ(nmea.mBdsBpAmpQ), |
| mGalBpAmpI(nmea.mGalBpAmpI), |
| mGalBpAmpQ(nmea.mGalBpAmpQ) |
| { |
| } |
| |
| bool SystemStatusRfAndParams::equals(const SystemStatusRfAndParams& peer) |
| { |
| if ((mPgaGain != peer.mPgaGain) || |
| (mGpsBpAmpI != peer.mGpsBpAmpI) || |
| (mGpsBpAmpQ != peer.mGpsBpAmpQ) || |
| (mAdcI != peer.mAdcI) || |
| (mAdcQ != peer.mAdcQ) || |
| (mJammerGps != peer.mJammerGps) || |
| (mJammerGlo != peer.mJammerGlo) || |
| (mJammerBds != peer.mJammerBds) || |
| (mJammerGal != peer.mJammerGal) || |
| (mAgcGps != peer.mAgcGps) || |
| (mAgcGlo != peer.mAgcGlo) || |
| (mAgcBds != peer.mAgcBds) || |
| (mAgcGal != peer.mAgcGal) || |
| (mGloBpAmpI != peer.mGloBpAmpI) || |
| (mGloBpAmpQ != peer.mGloBpAmpQ) || |
| (mBdsBpAmpI != peer.mBdsBpAmpI) || |
| (mBdsBpAmpQ != peer.mBdsBpAmpQ) || |
| (mGalBpAmpI != peer.mGalBpAmpI) || |
| (mGalBpAmpQ != peer.mGalBpAmpQ)) { |
| return false; |
| } |
| return true; |
| } |
| |
| void SystemStatusRfAndParams::dump() |
| { |
| LOC_LOGV("RfAndParams: u=%ld:%ld p=%d bi=%d bq=%d ai=%d aq=%d " |
| "jgp=%d jgl=%d jbd=%d jga=%d " |
| "agp=%lf agl=%lf abd=%lf aga=%lf", |
| mUtcTime.tv_sec, mUtcTime.tv_nsec, |
| mPgaGain, |
| mGpsBpAmpI, |
| mGpsBpAmpQ, |
| mAdcI, |
| mAdcQ, |
| mJammerGps, |
| mJammerGlo, |
| mJammerBds, |
| mJammerGal, |
| mAgcGps, |
| mAgcGlo, |
| mAgcBds, |
| mAgcGal); |
| return; |
| } |
| |
| /****************************************************************************** |
| SystemStatusErrRecovery |
| ******************************************************************************/ |
| SystemStatusErrRecovery::SystemStatusErrRecovery(const SystemStatusPQWM1& nmea) : |
| mRecErrorRecovery(nmea.mRecErrorRecovery) |
| { |
| } |
| |
| bool SystemStatusErrRecovery::equals(const SystemStatusErrRecovery& peer) |
| { |
| if (mRecErrorRecovery != peer.mRecErrorRecovery) { |
| return false; |
| } |
| return true; |
| } |
| |
| void SystemStatusErrRecovery::dump() |
| { |
| LOC_LOGV("ErrRecovery: u=%ld:%ld e=%d", |
| mUtcTime.tv_sec, mUtcTime.tv_nsec, |
| mRecErrorRecovery); |
| return; |
| } |
| |
| /****************************************************************************** |
| SystemStatusInjectedPosition |
| ******************************************************************************/ |
| SystemStatusInjectedPosition::SystemStatusInjectedPosition(const SystemStatusPQWP1& nmea) : |
| mEpiValidity(nmea.mEpiValidity), |
| mEpiLat(nmea.mEpiLat), |
| mEpiLon(nmea.mEpiLon), |
| mEpiAlt(nmea.mEpiAlt), |
| mEpiHepe(nmea.mEpiHepe), |
| mEpiAltUnc(nmea.mEpiAltUnc), |
| mEpiSrc(nmea.mEpiSrc) |
| { |
| } |
| |
| bool SystemStatusInjectedPosition::equals(const SystemStatusInjectedPosition& peer) |
| { |
| if ((mEpiValidity != peer.mEpiValidity) || |
| (mEpiLat != peer.mEpiLat) || |
| (mEpiLon != peer.mEpiLon) || |
| (mEpiAlt != peer.mEpiAlt) || |
| (mEpiHepe != peer.mEpiHepe) || |
| (mEpiAltUnc != peer.mEpiAltUnc) || |
| (mEpiSrc != peer.mEpiSrc)) { |
| return false; |
| } |
| return true; |
| } |
| |
| void SystemStatusInjectedPosition::dump() |
| { |
| LOC_LOGV("InjectedPosition: u=%ld:%ld v=%x la=%f lo=%f al=%f he=%f au=%f es=%d", |
| mUtcTime.tv_sec, mUtcTime.tv_nsec, |
| mEpiValidity, |
| mEpiLat, |
| mEpiLon, |
| mEpiAlt, |
| mEpiHepe, |
| mEpiAltUnc, |
| mEpiSrc); |
| return; |
| } |
| |
| /****************************************************************************** |
| SystemStatusBestPosition |
| ******************************************************************************/ |
| SystemStatusBestPosition::SystemStatusBestPosition(const SystemStatusPQWP2& nmea) : |
| mValid(true), |
| mBestLat(nmea.mBestLat), |
| mBestLon(nmea.mBestLon), |
| mBestAlt(nmea.mBestAlt), |
| mBestHepe(nmea.mBestHepe), |
| mBestAltUnc(nmea.mBestAltUnc) |
| { |
| } |
| |
| bool SystemStatusBestPosition::equals(const SystemStatusBestPosition& peer) |
| { |
| if ((mBestLat != peer.mBestLat) || |
| (mBestLon != peer.mBestLon) || |
| (mBestAlt != peer.mBestAlt) || |
| (mBestHepe != peer.mBestHepe) || |
| (mBestAltUnc != peer.mBestAltUnc)) { |
| return false; |
| } |
| return true; |
| } |
| |
| void SystemStatusBestPosition::dump() |
| { |
| LOC_LOGV("BestPosition: u=%ld:%ld la=%f lo=%f al=%f he=%f au=%f", |
| mUtcTime.tv_sec, mUtcTime.tv_nsec, |
| mBestLat, |
| mBestLon, |
| mBestAlt, |
| mBestHepe, |
| mBestAltUnc); |
| return; |
| } |
| |
| /****************************************************************************** |
| SystemStatusXtra |
| ******************************************************************************/ |
| SystemStatusXtra::SystemStatusXtra(const SystemStatusPQWP3& nmea) : |
| mXtraValidMask(nmea.mXtraValidMask), |
| mGpsXtraAge(nmea.mGpsXtraAge), |
| mGloXtraAge(nmea.mGloXtraAge), |
| mBdsXtraAge(nmea.mBdsXtraAge), |
| mGalXtraAge(nmea.mGalXtraAge), |
| mQzssXtraAge(nmea.mQzssXtraAge), |
| mNavicXtraAge(nmea.mNavicXtraAge), |
| mGpsXtraValid(nmea.mGpsXtraValid), |
| mGloXtraValid(nmea.mGloXtraValid), |
| mBdsXtraValid(nmea.mBdsXtraValid), |
| mGalXtraValid(nmea.mGalXtraValid), |
| mQzssXtraValid(nmea.mQzssXtraValid), |
| mNavicXtraValid(nmea.mNavicXtraValid) |
| { |
| } |
| |
| bool SystemStatusXtra::equals(const SystemStatusXtra& peer) |
| { |
| if ((mXtraValidMask != peer.mXtraValidMask) || |
| (mGpsXtraAge != peer.mGpsXtraAge) || |
| (mGloXtraAge != peer.mGloXtraAge) || |
| (mBdsXtraAge != peer.mBdsXtraAge) || |
| (mGalXtraAge != peer.mGalXtraAge) || |
| (mQzssXtraAge != peer.mQzssXtraAge) || |
| (mNavicXtraAge != peer.mNavicXtraAge) || |
| (mGpsXtraValid != peer.mGpsXtraValid) || |
| (mGloXtraValid != peer.mGloXtraValid) || |
| (mBdsXtraValid != peer.mBdsXtraValid) || |
| (mGalXtraValid != peer.mGalXtraValid) || |
| (mQzssXtraValid != peer.mQzssXtraValid) || |
| (mNavicXtraValid != peer.mNavicXtraValid)) { |
| return false; |
| } |
| return true; |
| } |
| |
| void SystemStatusXtra::dump() |
| { |
| LOC_LOGV("SystemStatusXtra: u=%ld:%ld m=%x a=%d:%d:%d:%d:%d v=%x:%x:%" PRIx64 ":%" PRIx64":%x", |
| mUtcTime.tv_sec, mUtcTime.tv_nsec, |
| mXtraValidMask, |
| mGpsXtraAge, |
| mGloXtraAge, |
| mBdsXtraAge, |
| mGalXtraAge, |
| mQzssXtraAge, |
| mGpsXtraValid, |
| mGloXtraValid, |
| mBdsXtraValid, |
| mGalXtraValid, |
| mQzssXtraValid); |
| return; |
| } |
| |
| /****************************************************************************** |
| SystemStatusEphemeris |
| ******************************************************************************/ |
| SystemStatusEphemeris::SystemStatusEphemeris(const SystemStatusPQWP4& nmea) : |
| mGpsEpheValid(nmea.mGpsEpheValid), |
| mGloEpheValid(nmea.mGloEpheValid), |
| mBdsEpheValid(nmea.mBdsEpheValid), |
| mGalEpheValid(nmea.mGalEpheValid), |
| mQzssEpheValid(nmea.mQzssEpheValid) |
| { |
| } |
| |
| bool SystemStatusEphemeris::equals(const SystemStatusEphemeris& peer) |
| { |
| if ((mGpsEpheValid != peer.mGpsEpheValid) || |
| (mGloEpheValid != peer.mGloEpheValid) || |
| (mBdsEpheValid != peer.mBdsEpheValid) || |
| (mGalEpheValid != peer.mGalEpheValid) || |
| (mQzssEpheValid != peer.mQzssEpheValid)) { |
| return false; |
| } |
| return true; |
| } |
| |
| void SystemStatusEphemeris::dump() |
| { |
| LOC_LOGV("Ephemeris: u=%ld:%ld ev=%x:%x:%" PRIx64 ":%" PRIx64 ":%x", |
| mUtcTime.tv_sec, mUtcTime.tv_nsec, |
| mGpsEpheValid, |
| mGloEpheValid, |
| mBdsEpheValid, |
| mGalEpheValid, |
| mQzssEpheValid); |
| return; |
| } |
| |
| /****************************************************************************** |
| SystemStatusSvHealth |
| ******************************************************************************/ |
| SystemStatusSvHealth::SystemStatusSvHealth(const SystemStatusPQWP5& nmea) : |
| mGpsUnknownMask(nmea.mGpsUnknownMask), |
| mGloUnknownMask(nmea.mGloUnknownMask), |
| mBdsUnknownMask(nmea.mBdsUnknownMask), |
| mGalUnknownMask(nmea.mGalUnknownMask), |
| mQzssUnknownMask(nmea.mQzssUnknownMask), |
| mNavicUnknownMask(nmea.mNavicUnknownMask), |
| mGpsGoodMask(nmea.mGpsGoodMask), |
| mGloGoodMask(nmea.mGloGoodMask), |
| mBdsGoodMask(nmea.mBdsGoodMask), |
| mGalGoodMask(nmea.mGalGoodMask), |
| mQzssGoodMask(nmea.mQzssGoodMask), |
| mNavicGoodMask(nmea.mNavicGoodMask), |
| mGpsBadMask(nmea.mGpsBadMask), |
| mGloBadMask(nmea.mGloBadMask), |
| mBdsBadMask(nmea.mBdsBadMask), |
| mGalBadMask(nmea.mGalBadMask), |
| mQzssBadMask(nmea.mQzssBadMask), |
| mNavicBadMask(nmea.mNavicBadMask) |
| { |
| } |
| |
| bool SystemStatusSvHealth::equals(const SystemStatusSvHealth& peer) |
| { |
| if ((mGpsUnknownMask != peer.mGpsUnknownMask) || |
| (mGloUnknownMask != peer.mGloUnknownMask) || |
| (mBdsUnknownMask != peer.mBdsUnknownMask) || |
| (mGalUnknownMask != peer.mGalUnknownMask) || |
| (mQzssUnknownMask != peer.mQzssUnknownMask) || |
| (mGpsGoodMask != peer.mGpsGoodMask) || |
| (mGloGoodMask != peer.mGloGoodMask) || |
| (mBdsGoodMask != peer.mBdsGoodMask) || |
| (mGalGoodMask != peer.mGalGoodMask) || |
| (mQzssGoodMask != peer.mQzssGoodMask) || |
| (mGpsBadMask != peer.mGpsBadMask) || |
| (mGloBadMask != peer.mGloBadMask) || |
| (mBdsBadMask != peer.mBdsBadMask) || |
| (mGalBadMask != peer.mGalBadMask) || |
| (mQzssBadMask != peer.mQzssBadMask)) { |
| return false; |
| } |
| return true; |
| } |
| |
| void SystemStatusSvHealth::dump() |
| { |
| LOC_LOGV("SvHealth: u=%ld:%ld \ |
| u=%x:%x:%" PRIx64 ":%" PRIx64 ":%x \ |
| g=%x:%x:%" PRIx64 ":%" PRIx64 ":%x \ |
| b=%x:%x:%" PRIx64 ":%" PRIx64 ":%x", |
| mUtcTime.tv_sec, mUtcTime.tv_nsec, |
| mGpsUnknownMask, |
| mGloUnknownMask, |
| mBdsUnknownMask, |
| mGalUnknownMask, |
| mQzssUnknownMask, |
| mGpsGoodMask, |
| mGloGoodMask, |
| mBdsGoodMask, |
| mGalGoodMask, |
| mQzssGoodMask, |
| mGpsBadMask, |
| mGloBadMask, |
| mBdsBadMask, |
| mGalBadMask, |
| mQzssBadMask); |
| return; |
| } |
| |
| /****************************************************************************** |
| SystemStatusPdr |
| ******************************************************************************/ |
| SystemStatusPdr::SystemStatusPdr(const SystemStatusPQWP6& nmea) : |
| mFixInfoMask(nmea.mFixInfoMask) |
| { |
| } |
| |
| bool SystemStatusPdr::equals(const SystemStatusPdr& peer) |
| { |
| if (mFixInfoMask != peer.mFixInfoMask) { |
| return false; |
| } |
| return true; |
| } |
| |
| void SystemStatusPdr::dump() |
| { |
| LOC_LOGV("Pdr: u=%ld:%ld m=%x", |
| mUtcTime.tv_sec, mUtcTime.tv_nsec, |
| mFixInfoMask); |
| return; |
| } |
| |
| /****************************************************************************** |
| SystemStatusNavData |
| ******************************************************************************/ |
| SystemStatusNavData::SystemStatusNavData(const SystemStatusPQWP7& nmea) |
| { |
| for (uint32_t i=0; i<SV_ALL_NUM; i++) { |
| mNav[i] = nmea.mNav[i]; |
| } |
| } |
| |
| bool SystemStatusNavData::equals(const SystemStatusNavData& peer) |
| { |
| for (uint32_t i=0; i<SV_ALL_NUM; i++) { |
| if ((mNav[i].mType != peer.mNav[i].mType) || |
| (mNav[i].mSource != peer.mNav[i].mSource) || |
| (mNav[i].mAgeSec != peer.mNav[i].mAgeSec)) { |
| return false; |
| } |
| } |
| return true; |
| } |
| |
| void SystemStatusNavData::dump() |
| { |
| LOC_LOGV("NavData: u=%ld:%ld", |
| mUtcTime.tv_sec, mUtcTime.tv_nsec); |
| for (uint32_t i=0; i<SV_ALL_NUM; i++) { |
| LOC_LOGV("i=%d type=%d src=%d age=%d", |
| i, mNav[i].mType, mNav[i].mSource, mNav[i].mAgeSec); |
| } |
| return; |
| } |
| |
| /****************************************************************************** |
| SystemStatusPositionFailure |
| ******************************************************************************/ |
| SystemStatusPositionFailure::SystemStatusPositionFailure(const SystemStatusPQWS1& nmea) : |
| mFixInfoMask(nmea.mFixInfoMask), |
| mHepeLimit(nmea.mHepeLimit) |
| { |
| } |
| |
| bool SystemStatusPositionFailure::equals(const SystemStatusPositionFailure& peer) |
| { |
| if ((mFixInfoMask != peer.mFixInfoMask) || |
| (mHepeLimit != peer.mHepeLimit)) { |
| return false; |
| } |
| return true; |
| } |
| |
| void SystemStatusPositionFailure::dump() |
| { |
| LOC_LOGV("PositionFailure: u=%ld:%ld m=%d h=%d", |
| mUtcTime.tv_sec, mUtcTime.tv_nsec, |
| mFixInfoMask, |
| mHepeLimit); |
| return; |
| } |
| |
| /****************************************************************************** |
| SystemStatusLocation |
| ******************************************************************************/ |
| bool SystemStatusLocation::equals(const SystemStatusLocation& peer) |
| { |
| if ((mLocation.gpsLocation.latitude != peer.mLocation.gpsLocation.latitude) || |
| (mLocation.gpsLocation.longitude != peer.mLocation.gpsLocation.longitude) || |
| (mLocation.gpsLocation.altitude != peer.mLocation.gpsLocation.altitude)) { |
| return false; |
| } |
| return true; |
| } |
| |
| void SystemStatusLocation::dump() |
| { |
| LOC_LOGV("Location: lat=%f lon=%f alt=%f spd=%f", |
| mLocation.gpsLocation.latitude, |
| mLocation.gpsLocation.longitude, |
| mLocation.gpsLocation.altitude, |
| mLocation.gpsLocation.speed); |
| return; |
| } |
| |
| /****************************************************************************** |
| SystemStatus |
| ******************************************************************************/ |
| pthread_mutex_t SystemStatus::mMutexSystemStatus = PTHREAD_MUTEX_INITIALIZER; |
| SystemStatus* SystemStatus::mInstance = NULL; |
| |
| SystemStatus* SystemStatus::getInstance(const MsgTask* msgTask) |
| { |
| pthread_mutex_lock(&mMutexSystemStatus); |
| |
| if (!mInstance) { |
| // Instantiating for the first time. msgTask should not be NULL |
| if (msgTask == NULL) { |
| LOC_LOGE("SystemStatus: msgTask is NULL!!"); |
| pthread_mutex_unlock(&mMutexSystemStatus); |
| return NULL; |
| } |
| mInstance = new (nothrow) SystemStatus(msgTask); |
| LOC_LOGD("SystemStatus::getInstance:%p. Msgtask:%p", mInstance, msgTask); |
| } |
| |
| pthread_mutex_unlock(&mMutexSystemStatus); |
| return mInstance; |
| } |
| |
| void SystemStatus::destroyInstance() |
| { |
| delete mInstance; |
| mInstance = NULL; |
| } |
| |
| IOsObserver* SystemStatus::getOsObserver() |
| { |
| return &mSysStatusObsvr; |
| } |
| |
| SystemStatus::SystemStatus(const MsgTask* msgTask) : |
| mSysStatusObsvr(this, msgTask) |
| { |
| int result = 0; |
| ENTRY_LOG (); |
| mCache.mLocation.clear(); |
| |
| mCache.mTimeAndClock.clear(); |
| mCache.mXoState.clear(); |
| mCache.mRfAndParams.clear(); |
| mCache.mErrRecovery.clear(); |
| |
| mCache.mInjectedPosition.clear(); |
| mCache.mBestPosition.clear(); |
| mCache.mXtra.clear(); |
| mCache.mEphemeris.clear(); |
| mCache.mSvHealth.clear(); |
| mCache.mPdr.clear(); |
| mCache.mNavData.clear(); |
| |
| mCache.mPositionFailure.clear(); |
| |
| mCache.mAirplaneMode.clear(); |
| mCache.mENH.clear(); |
| mCache.mGPSState.clear(); |
| mCache.mNLPStatus.clear(); |
| mCache.mWifiHardwareState.clear(); |
| mCache.mNetworkInfo.clear(); |
| mCache.mRilServiceInfo.clear(); |
| mCache.mRilCellInfo.clear(); |
| mCache.mServiceStatus.clear(); |
| mCache.mModel.clear(); |
| mCache.mManufacturer.clear(); |
| mCache.mAssistedGps.clear(); |
| mCache.mScreenState.clear(); |
| mCache.mPowerConnectState.clear(); |
| mCache.mTimeZoneChange.clear(); |
| mCache.mTimeChange.clear(); |
| mCache.mWifiSupplicantStatus.clear(); |
| mCache.mShutdownState.clear(); |
| mCache.mTac.clear(); |
| mCache.mMccMnc.clear(); |
| mCache.mBtDeviceScanDetail.clear(); |
| mCache.mBtLeDeviceScanDetail.clear(); |
| |
| EXIT_LOG_WITH_ERROR ("%d",result); |
| } |
| |
| /****************************************************************************** |
| SystemStatus - storing dataitems |
| ******************************************************************************/ |
| template <typename TYPE_REPORT, typename TYPE_ITEM> |
| bool SystemStatus::setIteminReport(TYPE_REPORT& report, TYPE_ITEM&& s) |
| { |
| if (s.ignore()) { |
| return false; |
| } |
| if (!report.empty() && report.back().equals(static_cast<TYPE_ITEM&>(s.collate(report.back())))) { |
| // there is no change - just update reported timestamp |
| report.back().mUtcReported = s.mUtcReported; |
| return false; |
| } |
| |
| // first event or updated |
| report.push_back(s); |
| if (report.size() > s.maxItem) { |
| report.erase(report.begin()); |
| } |
| return true; |
| } |
| |
| template <typename TYPE_REPORT, typename TYPE_ITEM> |
| void SystemStatus::setDefaultIteminReport(TYPE_REPORT& report, const TYPE_ITEM& s) |
| { |
| report.push_back(s); |
| if (report.size() > s.maxItem) { |
| report.erase(report.begin()); |
| } |
| } |
| |
| template <typename TYPE_REPORT, typename TYPE_ITEM> |
| void SystemStatus::getIteminReport(TYPE_REPORT& reportout, const TYPE_ITEM& c) const |
| { |
| reportout.clear(); |
| if (c.size() >= 1) { |
| reportout.push_back(c.back()); |
| reportout.back().dump(); |
| } |
| } |
| |
| /****************************************************************************** |
| @brief API to set report data into internal buffer |
| |
| @param[In] data pointer to the NMEA string |
| @param[In] len length of the NMEA string |
| |
| @return true when the NMEA is consumed by the method. |
| ******************************************************************************/ |
| bool SystemStatus::setNmeaString(const char *data, uint32_t len) |
| { |
| if (!loc_nmea_is_debug(data, len)) { |
| return false; |
| } |
| |
| char buf[SystemStatusNmeaBase::NMEA_MAXSIZE + 1] = { 0 }; |
| strlcpy(buf, data, sizeof(buf)); |
| |
| pthread_mutex_lock(&mMutexSystemStatus); |
| |
| // parse the received nmea strings here |
| if (0 == strncmp(data, "$PQWM1", SystemStatusNmeaBase::NMEA_MINSIZE)) { |
| SystemStatusPQWM1 s = SystemStatusPQWM1parser(buf, len).get(); |
| setIteminReport(mCache.mTimeAndClock, SystemStatusTimeAndClock(s)); |
| setIteminReport(mCache.mXoState, SystemStatusXoState(s)); |
| setIteminReport(mCache.mRfAndParams, SystemStatusRfAndParams(s)); |
| setIteminReport(mCache.mErrRecovery, SystemStatusErrRecovery(s)); |
| } |
| else if (0 == strncmp(data, "$PQWP1", SystemStatusNmeaBase::NMEA_MINSIZE)) { |
| setIteminReport(mCache.mInjectedPosition, |
| SystemStatusInjectedPosition(SystemStatusPQWP1parser(buf, len).get())); |
| } |
| else if (0 == strncmp(data, "$PQWP2", SystemStatusNmeaBase::NMEA_MINSIZE)) { |
| setIteminReport(mCache.mBestPosition, |
| SystemStatusBestPosition(SystemStatusPQWP2parser(buf, len).get())); |
| } |
| else if (0 == strncmp(data, "$PQWP3", SystemStatusNmeaBase::NMEA_MINSIZE)) { |
| setIteminReport(mCache.mXtra, |
| SystemStatusXtra(SystemStatusPQWP3parser(buf, len).get())); |
| } |
| else if (0 == strncmp(data, "$PQWP4", SystemStatusNmeaBase::NMEA_MINSIZE)) { |
| setIteminReport(mCache.mEphemeris, |
| SystemStatusEphemeris(SystemStatusPQWP4parser(buf, len).get())); |
| } |
| else if (0 == strncmp(data, "$PQWP5", SystemStatusNmeaBase::NMEA_MINSIZE)) { |
| setIteminReport(mCache.mSvHealth, |
| SystemStatusSvHealth(SystemStatusPQWP5parser(buf, len).get())); |
| } |
| else if (0 == strncmp(data, "$PQWP6", SystemStatusNmeaBase::NMEA_MINSIZE)) { |
| setIteminReport(mCache.mPdr, |
| SystemStatusPdr(SystemStatusPQWP6parser(buf, len).get())); |
| } |
| else if (0 == strncmp(data, "$PQWP7", SystemStatusNmeaBase::NMEA_MINSIZE)) { |
| setIteminReport(mCache.mNavData, |
| SystemStatusNavData(SystemStatusPQWP7parser(buf, len).get())); |
| } |
| else if (0 == strncmp(data, "$PQWS1", SystemStatusNmeaBase::NMEA_MINSIZE)) { |
| setIteminReport(mCache.mPositionFailure, |
| SystemStatusPositionFailure(SystemStatusPQWS1parser(buf, len).get())); |
| } |
| else { |
| // do nothing |
| } |
| |
| pthread_mutex_unlock(&mMutexSystemStatus); |
| return true; |
| } |
| |
| /****************************************************************************** |
| @brief API to set report position data into internal buffer |
| |
| @param[In] UlpLocation |
| |
| @return true when successfully done |
| ******************************************************************************/ |
| bool SystemStatus::eventPosition(const UlpLocation& location, |
| const GpsLocationExtended& locationEx) |
| { |
| bool ret = false; |
| pthread_mutex_lock(&mMutexSystemStatus); |
| |
| ret = setIteminReport(mCache.mLocation, SystemStatusLocation(location, locationEx)); |
| LOC_LOGV("eventPosition - lat=%f lon=%f alt=%f speed=%f", |
| location.gpsLocation.latitude, |
| location.gpsLocation.longitude, |
| location.gpsLocation.altitude, |
| location.gpsLocation.speed); |
| |
| pthread_mutex_unlock(&mMutexSystemStatus); |
| return ret; |
| } |
| |
| /****************************************************************************** |
| @brief API to set report DataItem event into internal buffer |
| |
| @param[In] DataItem |
| |
| @return true when info is updatated |
| ******************************************************************************/ |
| bool SystemStatus::eventDataItemNotify(IDataItemCore* dataitem) |
| { |
| bool ret = false; |
| pthread_mutex_lock(&mMutexSystemStatus); |
| switch(dataitem->getId()) |
| { |
| case AIRPLANEMODE_DATA_ITEM_ID: |
| ret = setIteminReport(mCache.mAirplaneMode, |
| SystemStatusAirplaneMode(*(static_cast<AirplaneModeDataItemBase*>(dataitem)))); |
| break; |
| case ENH_DATA_ITEM_ID: |
| ret = setIteminReport(mCache.mENH, |
| SystemStatusENH(*(static_cast<ENHDataItemBase*>(dataitem)))); |
| break; |
| case GPSSTATE_DATA_ITEM_ID: |
| ret = setIteminReport(mCache.mGPSState, |
| SystemStatusGpsState(*(static_cast<GPSStateDataItemBase*>(dataitem)))); |
| break; |
| case NLPSTATUS_DATA_ITEM_ID: |
| ret = setIteminReport(mCache.mNLPStatus, |
| SystemStatusNLPStatus(*(static_cast<NLPStatusDataItemBase*>(dataitem)))); |
| break; |
| case WIFIHARDWARESTATE_DATA_ITEM_ID: |
| ret = setIteminReport(mCache.mWifiHardwareState, |
| SystemStatusWifiHardwareState(*(static_cast<WifiHardwareStateDataItemBase*>(dataitem)))); |
| break; |
| case NETWORKINFO_DATA_ITEM_ID: |
| ret = setIteminReport(mCache.mNetworkInfo, |
| SystemStatusNetworkInfo(*(static_cast<NetworkInfoDataItemBase*>(dataitem)))); |
| break; |
| case RILSERVICEINFO_DATA_ITEM_ID: |
| ret = setIteminReport(mCache.mRilServiceInfo, |
| SystemStatusServiceInfo(*(static_cast<RilServiceInfoDataItemBase*>(dataitem)))); |
| break; |
| case RILCELLINFO_DATA_ITEM_ID: |
| ret = setIteminReport(mCache.mRilCellInfo, |
| SystemStatusRilCellInfo(*(static_cast<RilCellInfoDataItemBase*>(dataitem)))); |
| break; |
| case SERVICESTATUS_DATA_ITEM_ID: |
| ret = setIteminReport(mCache.mServiceStatus, |
| SystemStatusServiceStatus(*(static_cast<ServiceStatusDataItemBase*>(dataitem)))); |
| break; |
| case MODEL_DATA_ITEM_ID: |
| ret = setIteminReport(mCache.mModel, |
| SystemStatusModel(*(static_cast<ModelDataItemBase*>(dataitem)))); |
| break; |
| case MANUFACTURER_DATA_ITEM_ID: |
| ret = setIteminReport(mCache.mManufacturer, |
| SystemStatusManufacturer(*(static_cast<ManufacturerDataItemBase*>(dataitem)))); |
| break; |
| case ASSISTED_GPS_DATA_ITEM_ID: |
| ret = setIteminReport(mCache.mAssistedGps, |
| SystemStatusAssistedGps(*(static_cast<AssistedGpsDataItemBase*>(dataitem)))); |
| break; |
| case SCREEN_STATE_DATA_ITEM_ID: |
| ret = setIteminReport(mCache.mScreenState, |
| SystemStatusScreenState(*(static_cast<ScreenStateDataItemBase*>(dataitem)))); |
| break; |
| case POWER_CONNECTED_STATE_DATA_ITEM_ID: |
| ret = setIteminReport(mCache.mPowerConnectState, |
| SystemStatusPowerConnectState(*(static_cast<PowerConnectStateDataItemBase*>(dataitem)))); |
| break; |
| case TIMEZONE_CHANGE_DATA_ITEM_ID: |
| ret = setIteminReport(mCache.mTimeZoneChange, |
| SystemStatusTimeZoneChange(*(static_cast<TimeZoneChangeDataItemBase*>(dataitem)))); |
| break; |
| case TIME_CHANGE_DATA_ITEM_ID: |
| ret = setIteminReport(mCache.mTimeChange, |
| SystemStatusTimeChange(*(static_cast<TimeChangeDataItemBase*>(dataitem)))); |
| break; |
| case WIFI_SUPPLICANT_STATUS_DATA_ITEM_ID: |
| ret = setIteminReport(mCache.mWifiSupplicantStatus, |
| SystemStatusWifiSupplicantStatus(*(static_cast<WifiSupplicantStatusDataItemBase*>(dataitem)))); |
| break; |
| case SHUTDOWN_STATE_DATA_ITEM_ID: |
| ret = setIteminReport(mCache.mShutdownState, |
| SystemStatusShutdownState(*(static_cast<ShutdownStateDataItemBase*>(dataitem)))); |
| break; |
| case TAC_DATA_ITEM_ID: |
| ret = setIteminReport(mCache.mTac, |
| SystemStatusTac(*(static_cast<TacDataItemBase*>(dataitem)))); |
| break; |
| case MCCMNC_DATA_ITEM_ID: |
| ret = setIteminReport(mCache.mMccMnc, |
| SystemStatusMccMnc(*(static_cast<MccmncDataItemBase*>(dataitem)))); |
| break; |
| case BTLE_SCAN_DATA_ITEM_ID: |
| ret = setIteminReport(mCache.mBtDeviceScanDetail, |
| SystemStatusBtDeviceScanDetail(*(static_cast<BtDeviceScanDetailsDataItemBase*>(dataitem)))); |
| break; |
| case BT_SCAN_DATA_ITEM_ID: |
| ret = setIteminReport(mCache.mBtLeDeviceScanDetail, |
| SystemStatusBtleDeviceScanDetail(*(static_cast<BtLeDeviceScanDetailsDataItemBase*>(dataitem)))); |
| break; |
| default: |
| break; |
| } |
| pthread_mutex_unlock(&mMutexSystemStatus); |
| return ret; |
| } |
| |
| /****************************************************************************** |
| @brief API to get report data into a given buffer |
| |
| @param[In] reference to report buffer |
| @param[In] bool flag to identify latest only or entire buffer |
| |
| @return true when successfully done |
| ******************************************************************************/ |
| bool SystemStatus::getReport(SystemStatusReports& report, bool isLatestOnly) const |
| { |
| pthread_mutex_lock(&mMutexSystemStatus); |
| |
| if (isLatestOnly) { |
| // push back only the latest report and return it |
| getIteminReport(report.mLocation, mCache.mLocation); |
| |
| getIteminReport(report.mTimeAndClock, mCache.mTimeAndClock); |
| getIteminReport(report.mXoState, mCache.mXoState); |
| getIteminReport(report.mRfAndParams, mCache.mRfAndParams); |
| getIteminReport(report.mErrRecovery, mCache.mErrRecovery); |
| |
| getIteminReport(report.mInjectedPosition, mCache.mInjectedPosition); |
| getIteminReport(report.mBestPosition, mCache.mBestPosition); |
| getIteminReport(report.mXtra, mCache.mXtra); |
| getIteminReport(report.mEphemeris, mCache.mEphemeris); |
| getIteminReport(report.mSvHealth, mCache.mSvHealth); |
| getIteminReport(report.mPdr, mCache.mPdr); |
| getIteminReport(report.mNavData, mCache.mNavData); |
| |
| getIteminReport(report.mPositionFailure, mCache.mPositionFailure); |
| |
| getIteminReport(report.mAirplaneMode, mCache.mAirplaneMode); |
| getIteminReport(report.mENH, mCache.mENH); |
| getIteminReport(report.mGPSState, mCache.mGPSState); |
| getIteminReport(report.mNLPStatus, mCache.mNLPStatus); |
| getIteminReport(report.mWifiHardwareState, mCache.mWifiHardwareState); |
| getIteminReport(report.mNetworkInfo, mCache.mNetworkInfo); |
| getIteminReport(report.mRilServiceInfo, mCache.mRilServiceInfo); |
| getIteminReport(report.mRilCellInfo, mCache.mRilCellInfo); |
| getIteminReport(report.mServiceStatus, mCache.mServiceStatus); |
| getIteminReport(report.mModel, mCache.mModel); |
| getIteminReport(report.mManufacturer, mCache.mManufacturer); |
| getIteminReport(report.mAssistedGps, mCache.mAssistedGps); |
| getIteminReport(report.mScreenState, mCache.mScreenState); |
| getIteminReport(report.mPowerConnectState, mCache.mPowerConnectState); |
| getIteminReport(report.mTimeZoneChange, mCache.mTimeZoneChange); |
| getIteminReport(report.mTimeChange, mCache.mTimeChange); |
| getIteminReport(report.mWifiSupplicantStatus, mCache.mWifiSupplicantStatus); |
| getIteminReport(report.mShutdownState, mCache.mShutdownState); |
| getIteminReport(report.mTac, mCache.mTac); |
| getIteminReport(report.mMccMnc, mCache.mMccMnc); |
| getIteminReport(report.mBtDeviceScanDetail, mCache.mBtDeviceScanDetail); |
| getIteminReport(report.mBtLeDeviceScanDetail, mCache.mBtLeDeviceScanDetail); |
| } |
| else { |
| // copy entire reports and return them |
| report.mLocation.clear(); |
| |
| report.mTimeAndClock.clear(); |
| report.mXoState.clear(); |
| report.mRfAndParams.clear(); |
| report.mErrRecovery.clear(); |
| |
| report.mInjectedPosition.clear(); |
| report.mBestPosition.clear(); |
| report.mXtra.clear(); |
| report.mEphemeris.clear(); |
| report.mSvHealth.clear(); |
| report.mPdr.clear(); |
| report.mNavData.clear(); |
| |
| report.mPositionFailure.clear(); |
| |
| report.mAirplaneMode.clear(); |
| report.mENH.clear(); |
| report.mGPSState.clear(); |
| report.mNLPStatus.clear(); |
| report.mWifiHardwareState.clear(); |
| report.mNetworkInfo.clear(); |
| report.mRilServiceInfo.clear(); |
| report.mRilCellInfo.clear(); |
| report.mServiceStatus.clear(); |
| report.mModel.clear(); |
| report.mManufacturer.clear(); |
| report.mAssistedGps.clear(); |
| report.mScreenState.clear(); |
| report.mPowerConnectState.clear(); |
| report.mTimeZoneChange.clear(); |
| report.mTimeChange.clear(); |
| report.mWifiSupplicantStatus.clear(); |
| report.mShutdownState.clear(); |
| report.mTac.clear(); |
| report.mMccMnc.clear(); |
| report.mBtDeviceScanDetail.clear(); |
| report.mBtLeDeviceScanDetail.clear(); |
| |
| report = mCache; |
| } |
| |
| pthread_mutex_unlock(&mMutexSystemStatus); |
| return true; |
| } |
| |
| /****************************************************************************** |
| @brief API to set default report data |
| |
| @param[In] none |
| |
| @return true when successfully done |
| ******************************************************************************/ |
| bool SystemStatus::setDefaultGnssEngineStates(void) |
| { |
| pthread_mutex_lock(&mMutexSystemStatus); |
| |
| setDefaultIteminReport(mCache.mLocation, SystemStatusLocation()); |
| |
| setDefaultIteminReport(mCache.mTimeAndClock, SystemStatusTimeAndClock()); |
| setDefaultIteminReport(mCache.mXoState, SystemStatusXoState()); |
| setDefaultIteminReport(mCache.mRfAndParams, SystemStatusRfAndParams()); |
| setDefaultIteminReport(mCache.mErrRecovery, SystemStatusErrRecovery()); |
| |
| setDefaultIteminReport(mCache.mInjectedPosition, SystemStatusInjectedPosition()); |
| setDefaultIteminReport(mCache.mBestPosition, SystemStatusBestPosition()); |
| setDefaultIteminReport(mCache.mXtra, SystemStatusXtra()); |
| setDefaultIteminReport(mCache.mEphemeris, SystemStatusEphemeris()); |
| setDefaultIteminReport(mCache.mSvHealth, SystemStatusSvHealth()); |
| setDefaultIteminReport(mCache.mPdr, SystemStatusPdr()); |
| setDefaultIteminReport(mCache.mNavData, SystemStatusNavData()); |
| |
| setDefaultIteminReport(mCache.mPositionFailure, SystemStatusPositionFailure()); |
| |
| pthread_mutex_unlock(&mMutexSystemStatus); |
| return true; |
| } |
| |
| /****************************************************************************** |
| @brief API to handle connection status update event from GnssRil |
| |
| @param[In] Connection status |
| |
| @return true when successfully done |
| ******************************************************************************/ |
| bool SystemStatus::eventConnectionStatus(bool connected, int8_t type, |
| bool roaming, NetworkHandle networkHandle) |
| { |
| // send networkinof dataitem to systemstatus observer clients |
| SystemStatusNetworkInfo s(type, "", "", connected, roaming, |
| (uint64_t) networkHandle); |
| mSysStatusObsvr.notify({&s}); |
| |
| return true; |
| } |
| |
| /****************************************************************************** |
| @brief API to update power connect state |
| |
| @param[In] power connect status |
| |
| @return true when successfully done |
| ******************************************************************************/ |
| bool SystemStatus::updatePowerConnectState(bool charging) |
| { |
| SystemStatusPowerConnectState s(charging); |
| mSysStatusObsvr.notify({&s}); |
| return true; |
| } |
| } // namespace loc_core |
| |
