61fedb4567
ULP will no longer be loaded and init'ed from loc eng HAL. GPS HAL will look for ULP once it completes init and waits for a msg back once it hears from ULP. This is done with introduction of UlpProxy. Default proxy is a no op proxy. Change-Id: If0be0b5744f9de20f12c2f0b9704dea66aa454c0 (cherry picked from commit 2eb4ddcae94283df6c6be450c4c070ffd8ff9cd7)
429 lines
14 KiB
C++
429 lines
14 KiB
C++
/* Copyright (c) 2011-2013, 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_NDDEBUG 0
|
|
#define LOG_TAG "LocSvc_LocApiBase"
|
|
|
|
#include <dlfcn.h>
|
|
#include <LocApiBase.h>
|
|
#include <LocAdapterBase.h>
|
|
#include <log_util.h>
|
|
|
|
namespace loc_core {
|
|
|
|
#define TO_ALL_LOCADAPTERS(call) TO_ALL_ADAPTERS(mLocAdapters, (call))
|
|
#define TO_1ST_HANDLING_LOCADAPTERS(call) TO_1ST_HANDLING_ADAPTER(mLocAdapters, (call))
|
|
|
|
int hexcode(char *hexstring, int string_size,
|
|
const char *data, int data_size)
|
|
{
|
|
int i;
|
|
for (i = 0; i < data_size; i++)
|
|
{
|
|
char ch = data[i];
|
|
if (i*2 + 3 <= string_size)
|
|
{
|
|
snprintf(&hexstring[i*2], 3, "%02X", ch);
|
|
}
|
|
else {
|
|
break;
|
|
}
|
|
}
|
|
return i;
|
|
}
|
|
|
|
int decodeAddress(char *addr_string, int string_size,
|
|
const char *data, int data_size)
|
|
{
|
|
const char addr_prefix = 0x91;
|
|
int i, idxOutput = 0;
|
|
|
|
if (!data || !addr_string) { return 0; }
|
|
|
|
if (data[0] != addr_prefix)
|
|
{
|
|
LOC_LOGW("decodeAddress: address prefix is not 0x%x but 0x%x", addr_prefix, data[0]);
|
|
addr_string[0] = '\0';
|
|
return 0; // prefix not correct
|
|
}
|
|
|
|
for (i = 1; i < data_size; i++)
|
|
{
|
|
unsigned char ch = data[i], low = ch & 0x0F, hi = ch >> 4;
|
|
if (low <= 9 && idxOutput < string_size - 1) { addr_string[idxOutput++] = low + '0'; }
|
|
if (hi <= 9 && idxOutput < string_size - 1) { addr_string[idxOutput++] = hi + '0'; }
|
|
}
|
|
|
|
addr_string[idxOutput] = '\0'; // Terminates the string
|
|
|
|
return idxOutput;
|
|
}
|
|
|
|
struct LocSsrMsg : public LocMsg {
|
|
LocApiBase* mLocApi;
|
|
inline LocSsrMsg(LocApiBase* locApi) :
|
|
LocMsg(), mLocApi(locApi)
|
|
{
|
|
locallog();
|
|
}
|
|
inline virtual void proc() const {
|
|
mLocApi->close();
|
|
mLocApi->open(mLocApi->getEvtMask());
|
|
}
|
|
inline void locallog() {
|
|
LOC_LOGV("LocSsrMsg");
|
|
}
|
|
inline virtual void log() {
|
|
locallog();
|
|
}
|
|
};
|
|
|
|
LocApiBase::LocApiBase(const MsgTask* msgTask,
|
|
LOC_API_ADAPTER_EVENT_MASK_T excludedMask) :
|
|
mExcludedMask(excludedMask), mMsgTask(msgTask), mMask(0)
|
|
{
|
|
memset(mLocAdapters, 0, sizeof(mLocAdapters));
|
|
}
|
|
|
|
LOC_API_ADAPTER_EVENT_MASK_T LocApiBase::getEvtMask()
|
|
{
|
|
LOC_API_ADAPTER_EVENT_MASK_T mask = 0;
|
|
|
|
TO_ALL_LOCADAPTERS(mask |= mLocAdapters[i]->getEvtMask());
|
|
|
|
return mask & ~mExcludedMask;
|
|
}
|
|
|
|
bool LocApiBase::isInSession()
|
|
{
|
|
bool inSession = false;
|
|
|
|
TO_ALL_LOCADAPTERS(inSession = mLocAdapters[i]->isInSession());
|
|
|
|
return inSession;
|
|
}
|
|
|
|
void LocApiBase::addAdapter(LocAdapterBase* adapter)
|
|
{
|
|
for (int i = 0; i < MAX_ADAPTERS && mLocAdapters[i] != adapter; i++) {
|
|
if (mLocAdapters[i] == NULL) {
|
|
mLocAdapters[i] = adapter;
|
|
open(mMask | (adapter->getEvtMask() & ~mExcludedMask));
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
void LocApiBase::removeAdapter(LocAdapterBase* adapter)
|
|
{
|
|
for (int i = 0;
|
|
i < MAX_ADAPTERS && NULL != mLocAdapters[i];
|
|
i++) {
|
|
if (mLocAdapters[i] == adapter) {
|
|
mLocAdapters[i] = NULL;
|
|
|
|
// shift the rest of the adapters up so that the pointers
|
|
// in the array do not have holes. This should be more
|
|
// performant, because the array maintenance is much much
|
|
// less frequent than event handlings, which need to linear
|
|
// search all the adapters
|
|
int j = i;
|
|
while (++i < MAX_ADAPTERS && mLocAdapters[i] != NULL);
|
|
|
|
// i would be MAX_ADAPTERS or point to a NULL
|
|
i--;
|
|
// i now should point to a none NULL adapter within valid
|
|
// range although i could be equal to j, but it won't hurt.
|
|
// No need to check it, as it gains nothing.
|
|
mLocAdapters[j] = mLocAdapters[i];
|
|
// this makes sure that we exit the for loop
|
|
mLocAdapters[i] = NULL;
|
|
|
|
// if we have an empty list of adapters
|
|
if (0 == i) {
|
|
close();
|
|
} else {
|
|
// else we need to remove the bit
|
|
open(getEvtMask() & ~mExcludedMask);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
void LocApiBase::handleEngineUpEvent()
|
|
{
|
|
// This will take care of renegotiating the loc handle
|
|
mMsgTask->sendMsg(new LocSsrMsg(this));
|
|
|
|
// loop through adapters, and deliver to all adapters.
|
|
TO_ALL_LOCADAPTERS(mLocAdapters[i]->handleEngineUpEvent());
|
|
}
|
|
|
|
void LocApiBase::handleEngineDownEvent()
|
|
{
|
|
// loop through adapters, and deliver to all adapters.
|
|
TO_ALL_LOCADAPTERS(mLocAdapters[i]->handleEngineDownEvent());
|
|
}
|
|
|
|
void LocApiBase::reportPosition(UlpLocation &location,
|
|
GpsLocationExtended &locationExtended,
|
|
void* locationExt,
|
|
enum loc_sess_status status,
|
|
LocPosTechMask loc_technology_mask)
|
|
{
|
|
// loop through adapters, and deliver to all adapters.
|
|
TO_ALL_LOCADAPTERS(
|
|
mLocAdapters[i]->reportPosition(location,
|
|
locationExtended,
|
|
locationExt,
|
|
status,
|
|
loc_technology_mask)
|
|
);
|
|
}
|
|
|
|
void LocApiBase::reportSv(GpsSvStatus &svStatus,
|
|
GpsLocationExtended &locationExtended,
|
|
void* svExt)
|
|
{
|
|
// loop through adapters, and deliver to all adapters.
|
|
TO_ALL_LOCADAPTERS(
|
|
mLocAdapters[i]->reportSv(svStatus,
|
|
locationExtended,
|
|
svExt)
|
|
);
|
|
}
|
|
|
|
void LocApiBase::reportStatus(GpsStatusValue status)
|
|
{
|
|
// loop through adapters, and deliver to all adapters.
|
|
TO_ALL_LOCADAPTERS(mLocAdapters[i]->reportStatus(status));
|
|
}
|
|
|
|
void LocApiBase::reportNmea(const char* nmea, int length)
|
|
{
|
|
// loop through adapters, and deliver to all adapters.
|
|
TO_ALL_LOCADAPTERS(mLocAdapters[i]->reportNmea(nmea, length));
|
|
}
|
|
|
|
void LocApiBase::reportXtraServer(const char* url1, const char* url2,
|
|
const char* url3, const int maxlength)
|
|
{
|
|
// loop through adapters, and deliver to the first handling adapter.
|
|
TO_1ST_HANDLING_LOCADAPTERS(mLocAdapters[i]->reportXtraServer(url1, url2, url3, maxlength));
|
|
|
|
}
|
|
|
|
void LocApiBase::requestXtraData()
|
|
{
|
|
// loop through adapters, and deliver to the first handling adapter.
|
|
TO_1ST_HANDLING_LOCADAPTERS(mLocAdapters[i]->requestXtraData());
|
|
}
|
|
|
|
void LocApiBase::requestTime()
|
|
{
|
|
// loop through adapters, and deliver to the first handling adapter.
|
|
TO_1ST_HANDLING_LOCADAPTERS(mLocAdapters[i]->requestTime());
|
|
}
|
|
|
|
void LocApiBase::requestLocation()
|
|
{
|
|
// loop through adapters, and deliver to the first handling adapter.
|
|
TO_1ST_HANDLING_LOCADAPTERS(mLocAdapters[i]->requestLocation());
|
|
}
|
|
|
|
void LocApiBase::requestATL(int connHandle, AGpsType agps_type)
|
|
{
|
|
// loop through adapters, and deliver to the first handling adapter.
|
|
TO_1ST_HANDLING_LOCADAPTERS(mLocAdapters[i]->requestATL(connHandle, agps_type));
|
|
}
|
|
|
|
void LocApiBase::releaseATL(int connHandle)
|
|
{
|
|
// loop through adapters, and deliver to the first handling adapter.
|
|
TO_1ST_HANDLING_LOCADAPTERS(mLocAdapters[i]->releaseATL(connHandle));
|
|
}
|
|
|
|
void LocApiBase::requestSuplES(int connHandle)
|
|
{
|
|
// loop through adapters, and deliver to the first handling adapter.
|
|
TO_1ST_HANDLING_LOCADAPTERS(mLocAdapters[i]->requestSuplES(connHandle));
|
|
}
|
|
|
|
void LocApiBase::reportDataCallOpened()
|
|
{
|
|
// loop through adapters, and deliver to the first handling adapter.
|
|
TO_1ST_HANDLING_LOCADAPTERS(mLocAdapters[i]->reportDataCallOpened());
|
|
}
|
|
|
|
void LocApiBase::reportDataCallClosed()
|
|
{
|
|
// loop through adapters, and deliver to the first handling adapter.
|
|
TO_1ST_HANDLING_LOCADAPTERS(mLocAdapters[i]->reportDataCallClosed());
|
|
}
|
|
|
|
void LocApiBase::requestNiNotify(GpsNiNotification ¬ify, const void* data)
|
|
{
|
|
// loop through adapters, and deliver to the first handling adapter.
|
|
TO_1ST_HANDLING_LOCADAPTERS(mLocAdapters[i]->requestNiNotify(notify, data));
|
|
}
|
|
|
|
enum loc_api_adapter_err LocApiBase::
|
|
open(LOC_API_ADAPTER_EVENT_MASK_T mask)
|
|
DEFAULT_IMPL(LOC_API_ADAPTER_ERR_SUCCESS)
|
|
|
|
enum loc_api_adapter_err LocApiBase::
|
|
close()
|
|
DEFAULT_IMPL(LOC_API_ADAPTER_ERR_SUCCESS)
|
|
|
|
enum loc_api_adapter_err LocApiBase::
|
|
startFix(const LocPosMode& posMode)
|
|
DEFAULT_IMPL(LOC_API_ADAPTER_ERR_SUCCESS)
|
|
|
|
enum loc_api_adapter_err LocApiBase::
|
|
stopFix()
|
|
DEFAULT_IMPL(LOC_API_ADAPTER_ERR_SUCCESS)
|
|
|
|
enum loc_api_adapter_err LocApiBase::
|
|
deleteAidingData(GpsAidingData f)
|
|
DEFAULT_IMPL(LOC_API_ADAPTER_ERR_SUCCESS)
|
|
|
|
enum loc_api_adapter_err LocApiBase::
|
|
enableData(int enable)
|
|
DEFAULT_IMPL(LOC_API_ADAPTER_ERR_SUCCESS)
|
|
|
|
enum loc_api_adapter_err LocApiBase::
|
|
setAPN(char* apn, int len)
|
|
DEFAULT_IMPL(LOC_API_ADAPTER_ERR_SUCCESS)
|
|
|
|
enum loc_api_adapter_err LocApiBase::
|
|
injectPosition(double latitude, double longitude, float accuracy)
|
|
DEFAULT_IMPL(LOC_API_ADAPTER_ERR_SUCCESS)
|
|
|
|
enum loc_api_adapter_err LocApiBase::
|
|
setTime(GpsUtcTime time, int64_t timeReference, int uncertainty)
|
|
DEFAULT_IMPL(LOC_API_ADAPTER_ERR_SUCCESS)
|
|
|
|
enum loc_api_adapter_err LocApiBase::
|
|
setXtraData(char* data, int length)
|
|
DEFAULT_IMPL(LOC_API_ADAPTER_ERR_SUCCESS)
|
|
|
|
enum loc_api_adapter_err LocApiBase::
|
|
requestXtraServer()
|
|
DEFAULT_IMPL(LOC_API_ADAPTER_ERR_SUCCESS)
|
|
|
|
enum loc_api_adapter_err LocApiBase::
|
|
atlOpenStatus(int handle, int is_succ, char* apn,
|
|
AGpsBearerType bear, AGpsType agpsType)
|
|
DEFAULT_IMPL(LOC_API_ADAPTER_ERR_SUCCESS)
|
|
|
|
enum loc_api_adapter_err LocApiBase::
|
|
atlCloseStatus(int handle, int is_succ)
|
|
DEFAULT_IMPL(LOC_API_ADAPTER_ERR_SUCCESS)
|
|
|
|
enum loc_api_adapter_err LocApiBase::
|
|
setPositionMode(const LocPosMode& posMode)
|
|
DEFAULT_IMPL(LOC_API_ADAPTER_ERR_SUCCESS)
|
|
|
|
enum loc_api_adapter_err LocApiBase::
|
|
setServer(const char* url, int len)
|
|
DEFAULT_IMPL(LOC_API_ADAPTER_ERR_SUCCESS)
|
|
|
|
enum loc_api_adapter_err LocApiBase::
|
|
setServer(unsigned int ip, int port,
|
|
LocServerType type)
|
|
DEFAULT_IMPL(LOC_API_ADAPTER_ERR_SUCCESS)
|
|
|
|
enum loc_api_adapter_err LocApiBase::
|
|
informNiResponse(GpsUserResponseType userResponse,
|
|
const void* passThroughData)
|
|
DEFAULT_IMPL(LOC_API_ADAPTER_ERR_SUCCESS)
|
|
|
|
enum loc_api_adapter_err LocApiBase::
|
|
setSUPLVersion(uint32_t version)
|
|
DEFAULT_IMPL(LOC_API_ADAPTER_ERR_SUCCESS)
|
|
|
|
enum loc_api_adapter_err LocApiBase::
|
|
setLPPConfig(uint32_t profile)
|
|
DEFAULT_IMPL(LOC_API_ADAPTER_ERR_SUCCESS)
|
|
|
|
enum loc_api_adapter_err LocApiBase::
|
|
setSensorControlConfig(int sensorUsage)
|
|
DEFAULT_IMPL(LOC_API_ADAPTER_ERR_SUCCESS)
|
|
|
|
enum loc_api_adapter_err LocApiBase::
|
|
setSensorProperties(bool gyroBiasVarianceRandomWalk_valid,
|
|
float gyroBiasVarianceRandomWalk,
|
|
bool accelBiasVarianceRandomWalk_valid,
|
|
float accelBiasVarianceRandomWalk,
|
|
bool angleBiasVarianceRandomWalk_valid,
|
|
float angleBiasVarianceRandomWalk,
|
|
bool rateBiasVarianceRandomWalk_valid,
|
|
float rateBiasVarianceRandomWalk,
|
|
bool velocityBiasVarianceRandomWalk_valid,
|
|
float velocityBiasVarianceRandomWalk)
|
|
DEFAULT_IMPL(LOC_API_ADAPTER_ERR_SUCCESS)
|
|
|
|
enum loc_api_adapter_err LocApiBase::
|
|
setSensorPerfControlConfig(int controlMode,
|
|
int accelSamplesPerBatch,
|
|
int accelBatchesPerSec,
|
|
int gyroSamplesPerBatch,
|
|
int gyroBatchesPerSec,
|
|
int accelSamplesPerBatchHigh,
|
|
int accelBatchesPerSecHigh,
|
|
int gyroSamplesPerBatchHigh,
|
|
int gyroBatchesPerSecHigh,
|
|
int algorithmConfig)
|
|
DEFAULT_IMPL(LOC_API_ADAPTER_ERR_SUCCESS)
|
|
|
|
enum loc_api_adapter_err LocApiBase::
|
|
setExtPowerConfig(int isBatteryCharging)
|
|
DEFAULT_IMPL(LOC_API_ADAPTER_ERR_SUCCESS)
|
|
|
|
enum loc_api_adapter_err LocApiBase::
|
|
setAGLONASSProtocol(unsigned long aGlonassProtocol)
|
|
DEFAULT_IMPL(LOC_API_ADAPTER_ERR_SUCCESS)
|
|
|
|
int LocApiBase::
|
|
initDataServiceClient()
|
|
DEFAULT_IMPL(-1)
|
|
|
|
int LocApiBase::
|
|
openAndStartDataCall()
|
|
DEFAULT_IMPL(-1)
|
|
|
|
void LocApiBase::
|
|
stopDataCall()
|
|
DEFAULT_IMPL()
|
|
|
|
void LocApiBase::
|
|
closeDataCall()
|
|
DEFAULT_IMPL()
|
|
|
|
|
|
} // namespace loc_core
|