| /* Copyright (c) 2017-2020 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_XtraSystemStatusObs" |
| |
| #include <sys/stat.h> |
| #include <sys/un.h> |
| #include <errno.h> |
| #include <ctype.h> |
| #include <cutils/properties.h> |
| #include <math.h> |
| #include <arpa/inet.h> |
| #include <netinet/in.h> |
| #include <netdb.h> |
| #include <string> |
| #include <loc_log.h> |
| #include <loc_nmea.h> |
| #include <SystemStatus.h> |
| #include <vector> |
| #include <sstream> |
| #include <XtraSystemStatusObserver.h> |
| #include <LocAdapterBase.h> |
| #include <DataItemId.h> |
| #include <DataItemsFactoryProxy.h> |
| #include <DataItemConcreteTypesBase.h> |
| |
| using namespace loc_util; |
| using namespace loc_core; |
| |
| #ifdef LOG_TAG |
| #undef LOG_TAG |
| #endif |
| #define LOG_TAG "LocSvc_XSSO" |
| |
| class XtraIpcListener : public ILocIpcListener { |
| IOsObserver* mSystemStatusObsrvr; |
| const MsgTask* mMsgTask; |
| XtraSystemStatusObserver& mXSSO; |
| public: |
| inline XtraIpcListener(IOsObserver* observer, const MsgTask* msgTask, |
| XtraSystemStatusObserver& xsso) : |
| mSystemStatusObsrvr(observer), mMsgTask(msgTask), mXSSO(xsso) {} |
| virtual void onReceive(const char* data, uint32_t length __unused, |
| const LocIpcRecver* recver __unused) override { |
| #define STRNCMP(str, constStr) strncmp(str, constStr, sizeof(constStr)-1) |
| if (!STRNCMP(data, "ping")) { |
| LOC_LOGd("ping received"); |
| #ifdef USE_GLIB |
| } else if (!STRNCMP(data, "connectBackhaul")) { |
| char clientName[30] = {0}; |
| sscanf(data, "%*s %29s", clientName); |
| mSystemStatusObsrvr->connectBackhaul(string(clientName)); |
| } else if (!STRNCMP(data, "disconnectBackhaul")) { |
| char clientName[30] = {0}; |
| sscanf(data, "%*s %29s", clientName); |
| mSystemStatusObsrvr->disconnectBackhaul(string(clientName)); |
| #endif |
| } else if (!STRNCMP(data, "requestStatus")) { |
| int32_t xtraStatusUpdated = 0; |
| sscanf(data, "%*s %d", &xtraStatusUpdated); |
| |
| struct HandleStatusRequestMsg : public LocMsg { |
| XtraSystemStatusObserver& mXSSO; |
| int32_t mXtraStatusUpdated; |
| inline HandleStatusRequestMsg(XtraSystemStatusObserver& xsso, |
| int32_t xtraStatusUpdated) : |
| mXSSO(xsso), mXtraStatusUpdated(xtraStatusUpdated) {} |
| inline void proc() const override { |
| mXSSO.onStatusRequested(mXtraStatusUpdated); |
| /* SSR for DGnss Ntrip Source*/ |
| mXSSO.restartDgnssSource(); |
| } |
| }; |
| mMsgTask->sendMsg(new HandleStatusRequestMsg(mXSSO, xtraStatusUpdated)); |
| } else { |
| LOC_LOGw("unknown event: %s", data); |
| } |
| } |
| }; |
| |
| XtraSystemStatusObserver::XtraSystemStatusObserver(IOsObserver* sysStatObs, |
| const MsgTask* msgTask) : |
| mSystemStatusObsrvr(sysStatObs), mMsgTask(msgTask), |
| mGpsLock(-1), mConnections(~0), mXtraThrottle(true), |
| mReqStatusReceived(false), |
| mIsConnectivityStatusKnown(false), |
| mSender(LocIpc::getLocIpcLocalSender(LOC_IPC_XTRA)), |
| mDelayLocTimer(*mSender) { |
| subscribe(true); |
| auto recver = LocIpc::getLocIpcLocalRecver( |
| make_shared<XtraIpcListener>(sysStatObs, msgTask, *this), |
| LOC_IPC_HAL); |
| mIpc.startNonBlockingListening(recver); |
| mDelayLocTimer.start(100 /*.1 sec*/, false); |
| } |
| |
| bool XtraSystemStatusObserver::updateLockStatus(GnssConfigGpsLock lock) { |
| // mask NI(NFW bit) since from XTRA's standpoint GPS is enabled if |
| // MO(AFW bit) is enabled and disabled when MO is disabled |
| mGpsLock = lock & ~GNSS_CONFIG_GPS_LOCK_NI; |
| |
| if (!mReqStatusReceived) { |
| return true; |
| } |
| |
| stringstream ss; |
| ss << "gpslock"; |
| ss << " " << mGpsLock; |
| string s = ss.str(); |
| return ( LocIpc::send(*mSender, (const uint8_t*)s.data(), s.size()) ); |
| } |
| |
| bool XtraSystemStatusObserver::updateConnections(uint64_t allConnections, |
| NetworkInfoType* networkHandleInfo) { |
| mIsConnectivityStatusKnown = true; |
| mConnections = allConnections; |
| |
| LOC_LOGd("updateConnections mConnections:%" PRIx64, mConnections); |
| for (uint8_t i = 0; i < MAX_NETWORK_HANDLES; ++i) { |
| mNetworkHandle[i] = networkHandleInfo[i]; |
| LOC_LOGd("updateConnections [%d] networkHandle:%" PRIx64 " networkType:%u", |
| i, mNetworkHandle[i].networkHandle, mNetworkHandle[i].networkType); |
| } |
| |
| if (!mReqStatusReceived) { |
| return true; |
| } |
| |
| stringstream ss; |
| ss << "connection" << endl << mConnections << endl |
| << mNetworkHandle[0].toString() << endl |
| << mNetworkHandle[1].toString() << endl |
| << mNetworkHandle[2].toString() << endl |
| << mNetworkHandle[3].toString() << endl |
| << mNetworkHandle[4].toString() << endl |
| << mNetworkHandle[5].toString() << endl |
| << mNetworkHandle[6].toString() << endl |
| << mNetworkHandle[7].toString() << endl |
| << mNetworkHandle[8].toString() << endl |
| << mNetworkHandle[MAX_NETWORK_HANDLES-1].toString(); |
| string s = ss.str(); |
| return ( LocIpc::send(*mSender, (const uint8_t*)s.data(), s.size()) ); |
| } |
| |
| bool XtraSystemStatusObserver::updateTac(const string& tac) { |
| mTac = tac; |
| |
| if (!mReqStatusReceived) { |
| return true; |
| } |
| |
| stringstream ss; |
| ss << "tac"; |
| ss << " " << tac.c_str(); |
| string s = ss.str(); |
| return ( LocIpc::send(*mSender, (const uint8_t*)s.data(), s.size()) ); |
| } |
| |
| bool XtraSystemStatusObserver::updateMccMnc(const string& mccmnc) { |
| mMccmnc = mccmnc; |
| |
| if (!mReqStatusReceived) { |
| return true; |
| } |
| |
| stringstream ss; |
| ss << "mncmcc"; |
| ss << " " << mccmnc.c_str(); |
| string s = ss.str(); |
| return ( LocIpc::send(*mSender, (const uint8_t*)s.data(), s.size()) ); |
| } |
| |
| bool XtraSystemStatusObserver::updateXtraThrottle(const bool enabled) { |
| mXtraThrottle = enabled; |
| |
| if (!mReqStatusReceived) { |
| return true; |
| } |
| |
| stringstream ss; |
| ss << "xtrathrottle"; |
| ss << " " << (enabled ? 1 : 0); |
| string s = ss.str(); |
| return ( LocIpc::send(*mSender, (const uint8_t*)s.data(), s.size()) ); |
| } |
| |
| inline bool XtraSystemStatusObserver::onStatusRequested(int32_t xtraStatusUpdated) { |
| mReqStatusReceived = true; |
| |
| if (xtraStatusUpdated) { |
| return true; |
| } |
| |
| stringstream ss; |
| |
| ss << "respondStatus" << endl; |
| (mGpsLock == -1 ? ss : ss << mGpsLock) << endl; |
| (mConnections == (uint64_t)~0 ? ss : ss << mConnections) << endl |
| << mNetworkHandle[0].toString() << endl |
| << mNetworkHandle[1].toString() << endl |
| << mNetworkHandle[2].toString() << endl |
| << mNetworkHandle[3].toString() << endl |
| << mNetworkHandle[4].toString() << endl |
| << mNetworkHandle[5].toString() << endl |
| << mNetworkHandle[6].toString() << endl |
| << mNetworkHandle[7].toString() << endl |
| << mNetworkHandle[8].toString() << endl |
| << mNetworkHandle[MAX_NETWORK_HANDLES-1].toString() << endl |
| << mTac << endl << mMccmnc << endl << mIsConnectivityStatusKnown; |
| |
| string s = ss.str(); |
| return ( LocIpc::send(*mSender, (const uint8_t*)s.data(), s.size()) ); |
| } |
| |
| void XtraSystemStatusObserver::startDgnssSource(const StartDgnssNtripParams& params) { |
| stringstream ss; |
| const GnssNtripConnectionParams* ntripParams = &(params.ntripParams); |
| |
| ss << "startDgnssSource" << endl; |
| ss << ntripParams->useSSL << endl; |
| ss << ntripParams->hostNameOrIp.data() << endl; |
| ss << ntripParams->port << endl; |
| ss << ntripParams->mountPoint.data() << endl; |
| ss << ntripParams->username.data() << endl; |
| ss << ntripParams->password.data() << endl; |
| if (ntripParams->requiresNmeaLocation && !params.nmea.empty()) { |
| ss << params.nmea.data() << endl; |
| } |
| string s = ss.str(); |
| |
| LOC_LOGd("%s", s.data()); |
| LocIpc::send(*mSender, (const uint8_t*)s.data(), s.size()); |
| // make a local copy of the string for SSR |
| mNtripParamsString.assign(std::move(s)); |
| } |
| |
| void XtraSystemStatusObserver::restartDgnssSource() { |
| if (!mNtripParamsString.empty()) { |
| LocIpc::send(*mSender, |
| (const uint8_t*)mNtripParamsString.data(), mNtripParamsString.size()); |
| LOC_LOGv("Xtra SSR %s", mNtripParamsString.data()); |
| } |
| } |
| |
| void XtraSystemStatusObserver::stopDgnssSource() { |
| LOC_LOGv(); |
| mNtripParamsString.clear(); |
| |
| const char s[] = "stopDgnssSource"; |
| LocIpc::send(*mSender, (const uint8_t*)s, strlen(s)); |
| } |
| |
| void XtraSystemStatusObserver::updateNmeaToDgnssServer(const string& nmea) |
| { |
| stringstream ss; |
| ss << "updateDgnssServerNmea" << endl; |
| ss << nmea.data() << endl; |
| |
| string s = ss.str(); |
| LOC_LOGd("%s", s.data()); |
| LocIpc::send(*mSender, (const uint8_t*)s.data(), s.size()); |
| } |
| |
| void XtraSystemStatusObserver::subscribe(bool yes) |
| { |
| // Subscription data list |
| list<DataItemId> subItemIdList; |
| subItemIdList.push_back(NETWORKINFO_DATA_ITEM_ID); |
| subItemIdList.push_back(MCCMNC_DATA_ITEM_ID); |
| |
| if (yes) { |
| mSystemStatusObsrvr->subscribe(subItemIdList, this); |
| |
| list<DataItemId> reqItemIdList; |
| reqItemIdList.push_back(TAC_DATA_ITEM_ID); |
| |
| mSystemStatusObsrvr->requestData(reqItemIdList, this); |
| |
| } else { |
| mSystemStatusObsrvr->unsubscribe(subItemIdList, this); |
| } |
| } |
| |
| // IDataItemObserver overrides |
| void XtraSystemStatusObserver::getName(string& name) |
| { |
| name = "XtraSystemStatusObserver"; |
| } |
| |
| void XtraSystemStatusObserver::notify(const list<IDataItemCore*>& dlist) |
| { |
| struct HandleOsObserverUpdateMsg : public LocMsg { |
| XtraSystemStatusObserver* mXtraSysStatObj; |
| list <IDataItemCore*> mDataItemList; |
| |
| inline HandleOsObserverUpdateMsg(XtraSystemStatusObserver* xtraSysStatObs, |
| const list<IDataItemCore*>& dataItemList) : |
| mXtraSysStatObj(xtraSysStatObs) { |
| for (auto eachItem : dataItemList) { |
| IDataItemCore* dataitem = DataItemsFactoryProxy::createNewDataItem( |
| eachItem->getId()); |
| if (NULL == dataitem) { |
| break; |
| } |
| // Copy the contents of the data item |
| dataitem->copy(eachItem); |
| |
| mDataItemList.push_back(dataitem); |
| } |
| } |
| |
| inline ~HandleOsObserverUpdateMsg() { |
| for (auto itor = mDataItemList.begin(); itor != mDataItemList.end(); ++itor) { |
| if (*itor != nullptr) { |
| delete *itor; |
| *itor = nullptr; |
| } |
| } |
| } |
| |
| inline void proc() const { |
| for (auto each : mDataItemList) { |
| switch (each->getId()) |
| { |
| case NETWORKINFO_DATA_ITEM_ID: |
| { |
| NetworkInfoDataItemBase* networkInfo = |
| static_cast<NetworkInfoDataItemBase*>(each); |
| NetworkInfoType* networkHandleInfo = |
| static_cast<NetworkInfoType*>(networkInfo->getNetworkHandle()); |
| mXtraSysStatObj->updateConnections(networkInfo->getAllTypes(), |
| networkHandleInfo); |
| } |
| break; |
| |
| case TAC_DATA_ITEM_ID: |
| { |
| TacDataItemBase* tac = |
| static_cast<TacDataItemBase*>(each); |
| mXtraSysStatObj->updateTac(tac->mValue); |
| } |
| break; |
| |
| case MCCMNC_DATA_ITEM_ID: |
| { |
| MccmncDataItemBase* mccmnc = |
| static_cast<MccmncDataItemBase*>(each); |
| mXtraSysStatObj->updateMccMnc(mccmnc->mValue); |
| } |
| break; |
| |
| default: |
| break; |
| } |
| } |
| } |
| }; |
| mMsgTask->sendMsg(new (nothrow) HandleOsObserverUpdateMsg(this, dlist)); |
| } |