You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
287 lines
14 KiB
287 lines
14 KiB
/* Copyright (c) 2017, 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_GnssMeasurementAPIClient"
|
|
|
|
#include <log_util.h>
|
|
#include <loc_cfg.h>
|
|
|
|
#include "LocationUtil.h"
|
|
#include "GnssMeasurementAPIClient.h"
|
|
|
|
namespace android {
|
|
namespace hardware {
|
|
namespace gnss {
|
|
namespace V1_0 {
|
|
namespace implementation {
|
|
|
|
static void convertGnssData(GnssMeasurementsNotification& in,
|
|
IGnssMeasurementCallback::GnssData& out);
|
|
static void convertGnssMeasurement(GnssMeasurementsData& in,
|
|
IGnssMeasurementCallback::GnssMeasurement& out);
|
|
static void convertGnssClock(GnssMeasurementsClock& in, IGnssMeasurementCallback::GnssClock& out);
|
|
|
|
GnssMeasurementAPIClient::GnssMeasurementAPIClient() :
|
|
mGnssMeasurementCbIface(nullptr),
|
|
mLocationCapabilitiesMask(0)
|
|
{
|
|
LOC_LOGD("%s]: ()", __FUNCTION__);
|
|
pthread_mutex_init(&mLock, nullptr);
|
|
pthread_cond_init (&mCond, nullptr);
|
|
|
|
// set default LocationOptions.
|
|
memset(&mLocationOptions, 0, sizeof(LocationOptions));
|
|
mLocationOptions.size = sizeof(LocationOptions);
|
|
mLocationOptions.minInterval = 1000;
|
|
mLocationOptions.minDistance = 0;
|
|
mLocationOptions.mode = GNSS_SUPL_MODE_STANDALONE;
|
|
}
|
|
|
|
GnssMeasurementAPIClient::~GnssMeasurementAPIClient()
|
|
{
|
|
LOC_LOGD("%s]: ()", __FUNCTION__);
|
|
pthread_cond_destroy(&mCond);
|
|
pthread_mutex_destroy(&mLock);
|
|
}
|
|
|
|
// for GpsInterface
|
|
Return<IGnssMeasurement::GnssMeasurementStatus>
|
|
GnssMeasurementAPIClient::gnssMeasurementSetCallback(const sp<IGnssMeasurementCallback>& callback)
|
|
{
|
|
LOC_LOGD("%s]: (%p)", __FUNCTION__, &callback);
|
|
|
|
mGnssMeasurementCbIface = callback;
|
|
|
|
LocationCallbacks locationCallbacks;
|
|
locationCallbacks.size = sizeof(LocationCallbacks);
|
|
|
|
locationCallbacks.trackingCb = nullptr;
|
|
locationCallbacks.batchingCb = nullptr;
|
|
locationCallbacks.geofenceBreachCb = nullptr;
|
|
locationCallbacks.geofenceStatusCb = nullptr;
|
|
locationCallbacks.gnssLocationInfoCb = nullptr;
|
|
locationCallbacks.gnssNiCb = nullptr;
|
|
locationCallbacks.gnssSvCb = nullptr;
|
|
locationCallbacks.gnssNmeaCb = nullptr;
|
|
|
|
locationCallbacks.gnssMeasurementsCb = nullptr;
|
|
if (mGnssMeasurementCbIface != nullptr) {
|
|
locationCallbacks.gnssMeasurementsCb =
|
|
[this](GnssMeasurementsNotification gnssMeasurementsNotification) {
|
|
onGnssMeasurementsCb(gnssMeasurementsNotification);
|
|
};
|
|
}
|
|
|
|
locAPISetCallbacks(locationCallbacks);
|
|
|
|
while (!mLocationCapabilitiesMask) {
|
|
LOC_LOGD("%s]: wait for capabilities...", __FUNCTION__);
|
|
pthread_mutex_lock(&mLock);
|
|
pthread_cond_wait(&mCond, &mLock);
|
|
pthread_mutex_unlock(&mLock);
|
|
}
|
|
if (mLocationCapabilitiesMask & LOCATION_CAPABILITIES_GNSS_MSB_BIT)
|
|
mLocationOptions.mode = GNSS_SUPL_MODE_MSB;
|
|
else
|
|
mLocationOptions.mode = GNSS_SUPL_MODE_STANDALONE;
|
|
LOC_LOGD("%s]: start tracking session", __FUNCTION__);
|
|
locAPIStartTracking(mLocationOptions);
|
|
|
|
return IGnssMeasurement::GnssMeasurementStatus::SUCCESS;
|
|
}
|
|
|
|
// for GpsMeasurementInterface
|
|
void GnssMeasurementAPIClient::gnssMeasurementClose() {
|
|
LOC_LOGD("%s]: ()", __FUNCTION__);
|
|
pthread_mutex_lock(&mLock);
|
|
mGnssMeasurementCbIface = nullptr;
|
|
pthread_mutex_unlock(&mLock);
|
|
locAPIStopTracking();
|
|
}
|
|
|
|
// callbacks
|
|
void GnssMeasurementAPIClient::onCapabilitiesCb(LocationCapabilitiesMask capabilitiesMask)
|
|
{
|
|
LOC_LOGD("%s]: (%02x)", __FUNCTION__, capabilitiesMask);
|
|
mLocationCapabilitiesMask = capabilitiesMask;
|
|
pthread_mutex_lock(&mLock);
|
|
pthread_cond_signal(&mCond);
|
|
pthread_mutex_unlock(&mLock);
|
|
}
|
|
|
|
void GnssMeasurementAPIClient::onGnssMeasurementsCb(
|
|
GnssMeasurementsNotification gnssMeasurementsNotification)
|
|
{
|
|
LOC_LOGD("%s]: (count: %zu)", __FUNCTION__, gnssMeasurementsNotification.count);
|
|
// we don't need to lock the mutext
|
|
// if mGnssMeasurementCbIface is set to nullptr
|
|
if (mGnssMeasurementCbIface != nullptr) {
|
|
pthread_mutex_lock(&mLock);
|
|
if (mGnssMeasurementCbIface != nullptr) {
|
|
IGnssMeasurementCallback::GnssData gnssData;
|
|
convertGnssData(gnssMeasurementsNotification, gnssData);
|
|
auto r = mGnssMeasurementCbIface->GnssMeasurementCb(gnssData);
|
|
if (!r.isOk()) {
|
|
LOC_LOGE("%s] Error from GnssMeasurementCb description=%s",
|
|
__func__, r.description().c_str());
|
|
}
|
|
}
|
|
pthread_mutex_unlock(&mLock);
|
|
}
|
|
}
|
|
|
|
static void convertGnssMeasurement(GnssMeasurementsData& in,
|
|
IGnssMeasurementCallback::GnssMeasurement& out)
|
|
{
|
|
memset(&out, 0, sizeof(IGnssMeasurementCallback::GnssMeasurement));
|
|
if (in.flags & GNSS_MEASUREMENTS_DATA_SIGNAL_TO_NOISE_RATIO_BIT)
|
|
out.flags |= IGnssMeasurementCallback::GnssMeasurementFlags::HAS_SNR;
|
|
if (in.flags & GNSS_MEASUREMENTS_DATA_CARRIER_FREQUENCY_BIT)
|
|
out.flags |= IGnssMeasurementCallback::GnssMeasurementFlags::HAS_CARRIER_FREQUENCY;
|
|
if (in.flags & GNSS_MEASUREMENTS_DATA_CARRIER_CYCLES_BIT)
|
|
out.flags |= IGnssMeasurementCallback::GnssMeasurementFlags::HAS_CARRIER_CYCLES;
|
|
if (in.flags & GNSS_MEASUREMENTS_DATA_CARRIER_PHASE_BIT)
|
|
out.flags |= IGnssMeasurementCallback::GnssMeasurementFlags::HAS_CARRIER_PHASE;
|
|
if (in.flags & GNSS_MEASUREMENTS_DATA_CARRIER_PHASE_UNCERTAINTY_BIT)
|
|
out.flags |= IGnssMeasurementCallback::GnssMeasurementFlags::HAS_CARRIER_PHASE_UNCERTAINTY;
|
|
if (in.flags & GNSS_MEASUREMENTS_DATA_AUTOMATIC_GAIN_CONTROL_BIT)
|
|
out.flags |= IGnssMeasurementCallback::GnssMeasurementFlags::HAS_AUTOMATIC_GAIN_CONTROL;
|
|
out.svid = in.svId;
|
|
convertGnssConstellationType(in.svType, out.constellation);
|
|
out.timeOffsetNs = in.timeOffsetNs;
|
|
if (in.stateMask & GNSS_MEASUREMENTS_STATE_CODE_LOCK_BIT)
|
|
out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_CODE_LOCK;
|
|
if (in.stateMask & GNSS_MEASUREMENTS_STATE_BIT_SYNC_BIT)
|
|
out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_BIT_SYNC;
|
|
if (in.stateMask & GNSS_MEASUREMENTS_STATE_SUBFRAME_SYNC_BIT)
|
|
out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_SUBFRAME_SYNC;
|
|
if (in.stateMask & GNSS_MEASUREMENTS_STATE_TOW_DECODED_BIT)
|
|
out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_TOW_DECODED;
|
|
if (in.stateMask & GNSS_MEASUREMENTS_STATE_MSEC_AMBIGUOUS_BIT)
|
|
out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_MSEC_AMBIGUOUS;
|
|
if (in.stateMask & GNSS_MEASUREMENTS_STATE_SYMBOL_SYNC_BIT)
|
|
out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_SYMBOL_SYNC;
|
|
if (in.stateMask & GNSS_MEASUREMENTS_STATE_GLO_STRING_SYNC_BIT)
|
|
out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_GLO_STRING_SYNC;
|
|
if (in.stateMask & GNSS_MEASUREMENTS_STATE_GLO_TOD_DECODED_BIT)
|
|
out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_GLO_TOD_DECODED;
|
|
if (in.stateMask & GNSS_MEASUREMENTS_STATE_BDS_D2_BIT_SYNC_BIT)
|
|
out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_BDS_D2_BIT_SYNC;
|
|
if (in.stateMask & GNSS_MEASUREMENTS_STATE_BDS_D2_SUBFRAME_SYNC_BIT)
|
|
out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_BDS_D2_SUBFRAME_SYNC;
|
|
if (in.stateMask & GNSS_MEASUREMENTS_STATE_GAL_E1BC_CODE_LOCK_BIT)
|
|
out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_GAL_E1BC_CODE_LOCK;
|
|
if (in.stateMask & GNSS_MEASUREMENTS_STATE_GAL_E1C_2ND_CODE_LOCK_BIT)
|
|
out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_GAL_E1C_2ND_CODE_LOCK;
|
|
if (in.stateMask & GNSS_MEASUREMENTS_STATE_GAL_E1B_PAGE_SYNC_BIT)
|
|
out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_GAL_E1B_PAGE_SYNC;
|
|
if (in.stateMask & GNSS_MEASUREMENTS_STATE_SBAS_SYNC_BIT)
|
|
out.state |= IGnssMeasurementCallback::GnssMeasurementState::STATE_SBAS_SYNC;
|
|
out.receivedSvTimeInNs = in.receivedSvTimeNs;
|
|
out.receivedSvTimeUncertaintyInNs = in.receivedSvTimeUncertaintyNs;
|
|
out.cN0DbHz = in.carrierToNoiseDbHz;
|
|
out.pseudorangeRateMps = in.pseudorangeRateMps;
|
|
out.pseudorangeRateUncertaintyMps = in.pseudorangeRateUncertaintyMps;
|
|
if (in.adrStateMask & GNSS_MEASUREMENTS_ACCUMULATED_DELTA_RANGE_STATE_VALID_BIT)
|
|
out.accumulatedDeltaRangeState |=
|
|
IGnssMeasurementCallback::GnssAccumulatedDeltaRangeState::ADR_STATE_VALID;
|
|
if (in.adrStateMask & GNSS_MEASUREMENTS_ACCUMULATED_DELTA_RANGE_STATE_RESET_BIT)
|
|
out.accumulatedDeltaRangeState |=
|
|
IGnssMeasurementCallback::GnssAccumulatedDeltaRangeState::ADR_STATE_RESET;
|
|
if (in.adrStateMask & GNSS_MEASUREMENTS_ACCUMULATED_DELTA_RANGE_STATE_CYCLE_SLIP_BIT)
|
|
out.accumulatedDeltaRangeState |=
|
|
IGnssMeasurementCallback::GnssAccumulatedDeltaRangeState::ADR_STATE_CYCLE_SLIP;
|
|
out.accumulatedDeltaRangeM = in.adrMeters;
|
|
out.accumulatedDeltaRangeUncertaintyM = in.adrUncertaintyMeters;
|
|
out.carrierFrequencyHz = in.carrierFrequencyHz;
|
|
out.carrierCycles = in.carrierCycles;
|
|
out.carrierPhase = in.carrierPhase;
|
|
out.carrierPhaseUncertainty = in.carrierPhaseUncertainty;
|
|
uint8_t indicator =
|
|
static_cast<uint8_t>(IGnssMeasurementCallback::GnssMultipathIndicator::INDICATOR_UNKNOWN);
|
|
if (in.multipathIndicator & GNSS_MEASUREMENTS_MULTIPATH_INDICATOR_PRESENT)
|
|
indicator |= IGnssMeasurementCallback::GnssMultipathIndicator::INDICATOR_PRESENT;
|
|
if (in.multipathIndicator & GNSS_MEASUREMENTS_MULTIPATH_INDICATOR_NOT_PRESENT)
|
|
indicator |= IGnssMeasurementCallback::GnssMultipathIndicator::INDICATIOR_NOT_PRESENT;
|
|
out.multipathIndicator =
|
|
static_cast<IGnssMeasurementCallback::GnssMultipathIndicator>(indicator);
|
|
out.snrDb = in.signalToNoiseRatioDb;
|
|
out.agcLevelDb = in.agcLevelDb;
|
|
}
|
|
|
|
static void convertGnssClock(GnssMeasurementsClock& in, IGnssMeasurementCallback::GnssClock& out)
|
|
{
|
|
memset(&out, 0, sizeof(IGnssMeasurementCallback::GnssClock));
|
|
if (in.flags & GNSS_MEASUREMENTS_CLOCK_FLAGS_LEAP_SECOND_BIT)
|
|
out.gnssClockFlags |= IGnssMeasurementCallback::GnssClockFlags::HAS_LEAP_SECOND;
|
|
if (in.flags & GNSS_MEASUREMENTS_CLOCK_FLAGS_TIME_UNCERTAINTY_BIT)
|
|
out.gnssClockFlags |= IGnssMeasurementCallback::GnssClockFlags::HAS_TIME_UNCERTAINTY;
|
|
if (in.flags & GNSS_MEASUREMENTS_CLOCK_FLAGS_FULL_BIAS_BIT)
|
|
out.gnssClockFlags |= IGnssMeasurementCallback::GnssClockFlags::HAS_FULL_BIAS;
|
|
if (in.flags & GNSS_MEASUREMENTS_CLOCK_FLAGS_BIAS_BIT)
|
|
out.gnssClockFlags |= IGnssMeasurementCallback::GnssClockFlags::HAS_BIAS;
|
|
if (in.flags & GNSS_MEASUREMENTS_CLOCK_FLAGS_BIAS_UNCERTAINTY_BIT)
|
|
out.gnssClockFlags |= IGnssMeasurementCallback::GnssClockFlags::HAS_BIAS_UNCERTAINTY;
|
|
if (in.flags & GNSS_MEASUREMENTS_CLOCK_FLAGS_DRIFT_BIT)
|
|
out.gnssClockFlags |= IGnssMeasurementCallback::GnssClockFlags::HAS_DRIFT;
|
|
if (in.flags & GNSS_MEASUREMENTS_CLOCK_FLAGS_DRIFT_UNCERTAINTY_BIT)
|
|
out.gnssClockFlags |= IGnssMeasurementCallback::GnssClockFlags::HAS_DRIFT_UNCERTAINTY;
|
|
out.leapSecond = in.leapSecond;
|
|
out.timeNs = in.timeNs;
|
|
out.timeUncertaintyNs = in.timeUncertaintyNs;
|
|
out.fullBiasNs = in.fullBiasNs;
|
|
out.biasNs = in.biasNs;
|
|
out.biasUncertaintyNs = in.biasUncertaintyNs;
|
|
out.driftNsps = in.driftNsps;
|
|
out.driftUncertaintyNsps = in.driftUncertaintyNsps;
|
|
out.hwClockDiscontinuityCount = in.hwClockDiscontinuityCount;
|
|
}
|
|
|
|
static void convertGnssData(GnssMeasurementsNotification& in,
|
|
IGnssMeasurementCallback::GnssData& out)
|
|
{
|
|
out.measurementCount = in.count;
|
|
if (out.measurementCount > static_cast<uint32_t>(GnssMax::SVS_COUNT)) {
|
|
LOC_LOGW("%s]: Too many measurement %zd. Clamps to %d.",
|
|
__FUNCTION__, out.measurementCount, GnssMax::SVS_COUNT);
|
|
out.measurementCount = static_cast<uint32_t>(GnssMax::SVS_COUNT);
|
|
}
|
|
for (size_t i = 0; i < out.measurementCount; i++) {
|
|
convertGnssMeasurement(in.measurements[i], out.measurements[i]);
|
|
}
|
|
convertGnssClock(in.clock, out.clock);
|
|
}
|
|
|
|
} // namespace implementation
|
|
} // namespace V1_0
|
|
} // namespace gnss
|
|
} // namespace hardware
|
|
} // namespace android
|