sm8250-common: import gps from LA.UM.9.12.r1-13500.01-SMxx50.QSSI12.0
Change-Id: Ib5a80c095e5e203f90cc0d685758553fd18a7f0c
This commit is contained in:
SGCMarkus
parent
e4e7e5be57
commit
72410cf795
270 changed files with 66183 additions and 615 deletions
384
gps/gnss/XtraSystemStatusObserver.cpp
Normal file
384
gps/gnss/XtraSystemStatusObserver.cpp
Normal file
|
|
@ -0,0 +1,384 @@
|
|||
/* 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,
|
||||
const LocIpcRecver* recver) 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));
|
||||
}
|
||||
Loading…
Add table
Add a link
Reference in a new issue