sm8450-common: Import gps from LA.VENDOR.1.0.r1-12800-WAIPIO.0
Change-Id: Ia76265a8c3326f2b5f9f260ce98807276af80ee3
This commit is contained in:
Arian
35
gps/android/auto_power/Android.bp
Normal file
35
gps/android/auto_power/Android.bp
Normal file
@@ -0,0 +1,35 @@
|
||||
|
||||
|
||||
cc_library_shared {
|
||||
|
||||
name: "libgnssauto_power",
|
||||
vendor: true,
|
||||
local_include_dirs: ["."],
|
||||
|
||||
srcs: ["GnssAutoPowerHandler.cpp"],
|
||||
|
||||
header_libs: [
|
||||
"libgps.utils_headers",
|
||||
"libloc_core_headers",
|
||||
"libloc_pla_headers",
|
||||
"vhal_v2_0_common_headers",
|
||||
"liblocation_api_headers",
|
||||
],
|
||||
|
||||
shared_libs: [
|
||||
"liblog",
|
||||
"libhidlbase",
|
||||
"libcutils",
|
||||
"libutils",
|
||||
"libgps.utils",
|
||||
"liblocation_api",
|
||||
"android.hardware.gnss@1.0",
|
||||
"android.hardware.health@1.0",
|
||||
"android.hardware.health@2.0",
|
||||
"android.hardware.power@1.2",
|
||||
"android.hardware.automotive.vehicle@2.0",
|
||||
"libbase",
|
||||
],
|
||||
|
||||
cflags: GNSS_CFLAGS,
|
||||
}
|
||||
290
gps/android/auto_power/GnssAutoPowerHandler.cpp
Normal file
290
gps/android/auto_power/GnssAutoPowerHandler.cpp
Normal file
@@ -0,0 +1,290 @@
|
||||
/*
|
||||
* Copyright (c) 2021 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_GnssAutoPowerHandler"
|
||||
|
||||
#include <log_util.h>
|
||||
#include <gps_extended_c.h>
|
||||
#include <utils/Mutex.h>
|
||||
#include "GnssAutoPowerHandler.h"
|
||||
#include "android-base/macros.h"
|
||||
#include <VehicleUtils.h>
|
||||
#include <chrono>
|
||||
#include <thread>
|
||||
|
||||
using android::Mutex;
|
||||
|
||||
// Power state report
|
||||
constexpr int32_t POWER_STATE_WAIT_FOR_VHAL =
|
||||
static_cast<int32_t>(VehicleApPowerStateReport::WAIT_FOR_VHAL);
|
||||
constexpr int32_t POWER_STATE_DEEP_SLEEP_ENTRY =
|
||||
static_cast<int32_t>(VehicleApPowerStateReport::DEEP_SLEEP_ENTRY);
|
||||
constexpr int32_t POWER_STATE_DEEP_SLEEP_EXIT =
|
||||
static_cast<int32_t>(VehicleApPowerStateReport::DEEP_SLEEP_EXIT);
|
||||
constexpr int32_t POWER_STATE_SHUTDOWN_POSTPONE =
|
||||
static_cast<int32_t>(VehicleApPowerStateReport::SHUTDOWN_POSTPONE);
|
||||
constexpr int32_t POWER_STATE_SHUTDOWN_START =
|
||||
static_cast<int32_t>(VehicleApPowerStateReport::SHUTDOWN_START);
|
||||
constexpr int32_t POWER_STATE_ON =
|
||||
static_cast<int32_t>(VehicleApPowerStateReport::ON);
|
||||
constexpr int32_t POWER_STATE_SHUTDOWN_PREPARE =
|
||||
static_cast<int32_t>(VehicleApPowerStateReport::SHUTDOWN_PREPARE);
|
||||
constexpr int32_t POWER_STATE_SHUTDOWN_CANCELLED =
|
||||
static_cast<int32_t>(VehicleApPowerStateReport::SHUTDOWN_CANCELLED);
|
||||
|
||||
static GnssAutoPowerHandler* sGnssAutoPowerHandler = nullptr;
|
||||
|
||||
/*VHidlDeathRecipient Implementation*/
|
||||
void GnssAutoPowerHandler::VHidlDeathRecipient::serviceDied(uint64_t cookie, const wp<IBase>& who) {
|
||||
mHandler->handleVHidlDeath(cookie, who);
|
||||
}
|
||||
|
||||
void GnssAutoPowerHandler::sendPowerEventToLocCtrlApi(PowerStateType intPowerState) {
|
||||
|
||||
if (NULL == mLocationControlApi)
|
||||
mLocationControlApi = LocationControlAPI::getInstance();
|
||||
|
||||
if (NULL != mLocationControlApi)
|
||||
mLocationControlApi->powerStateEvent(intPowerState);
|
||||
}
|
||||
|
||||
void GnssAutoPowerHandler::initializeGnssAutoPower() {
|
||||
bool retVal = false;
|
||||
|
||||
do {
|
||||
retVal = connectToVhal();
|
||||
|
||||
if (true != retVal) {
|
||||
LOC_LOGw("Could not connect to VHAL");
|
||||
}
|
||||
|
||||
//Sleep for 10ms for VHAL service to come-up before trying again.
|
||||
std::this_thread::sleep_for(std::chrono::milliseconds(50));
|
||||
} while (false == retVal);
|
||||
}
|
||||
|
||||
GnssAutoPowerHandler::GnssAutoPowerHandler():
|
||||
mVHidlDeathRecipient(new VHidlDeathRecipient(this)),
|
||||
mLocationControlApi(LocationControlAPI::getInstance()) {
|
||||
|
||||
sGnssAutoPowerHandler = this;
|
||||
|
||||
std::thread subscriptionThread ( [this]() {
|
||||
initializeGnssAutoPower();
|
||||
});
|
||||
subscriptionThread.detach();
|
||||
}
|
||||
|
||||
GnssAutoPowerHandler::~GnssAutoPowerHandler(){
|
||||
|
||||
}
|
||||
|
||||
bool GnssAutoPowerHandler::subscribeToVhal() {
|
||||
bool returnVal = false;
|
||||
constexpr int32_t prop = static_cast<int32_t>(VehicleProperty::AP_POWER_STATE_REPORT);
|
||||
|
||||
if (!isPropertySupported(prop)) {
|
||||
LOC_LOGW("Vehicle property(%d) is not supported by VHAL.", prop);
|
||||
return returnVal;
|
||||
}
|
||||
|
||||
VehiclePropValue propValue{
|
||||
.prop = prop,
|
||||
};
|
||||
|
||||
sp<IVehicle> vhalService;
|
||||
{
|
||||
Mutex::Autolock lock(mMutex);
|
||||
vhalService = mVhalService;
|
||||
}
|
||||
|
||||
StatusCode status;
|
||||
vhalService->get(propValue, [&status, &propValue](StatusCode s, const
|
||||
VehiclePropValue& value) {
|
||||
status = s;
|
||||
propValue = value;
|
||||
});
|
||||
if (status != StatusCode::OK) {
|
||||
LOC_LOGW("Failed to get vehicle property(%d) value.", prop);
|
||||
return returnVal;
|
||||
}
|
||||
|
||||
handleGnssAutoPowerEvent(propValue.value.int32Values[0]);
|
||||
|
||||
// Subscribe to AP_POWER_STATE_REPORT.
|
||||
SubscribeOptions reqVhalProperties[] = {
|
||||
{.propId = prop, .flags = SubscribeFlags::EVENTS_FROM_ANDROID},
|
||||
};
|
||||
hidl_vec<SubscribeOptions> options;
|
||||
options.setToExternal(reqVhalProperties, arraysize(reqVhalProperties));
|
||||
|
||||
status = vhalService->subscribe(this, options);
|
||||
|
||||
if (status != StatusCode::OK) {
|
||||
LOC_LOGW("%s], Failed to subscribe to vehicle property(%d).", __FUNCTION__, prop);
|
||||
} else {
|
||||
returnVal = true;
|
||||
}
|
||||
|
||||
return returnVal;
|
||||
} //GnssAutoPowerHandler::subscribeToVhal
|
||||
|
||||
bool GnssAutoPowerHandler::isPropertySupported(int32_t prop) {
|
||||
|
||||
if (mSupportedProperties.count(prop) > 0) {
|
||||
return mSupportedProperties[prop];
|
||||
}
|
||||
StatusCode status;
|
||||
hidl_vec<int32_t> props = {prop};
|
||||
sp<IVehicle> vhalService;
|
||||
{
|
||||
Mutex::Autolock lock(mMutex);
|
||||
vhalService = mVhalService;
|
||||
}
|
||||
vhalService->getPropConfigs(props,
|
||||
[&status](StatusCode s,
|
||||
hidl_vec<VehiclePropConfig>) {
|
||||
status = s;
|
||||
});
|
||||
mSupportedProperties[prop] = (status == StatusCode::OK);
|
||||
return mSupportedProperties[prop];
|
||||
|
||||
}
|
||||
|
||||
|
||||
bool GnssAutoPowerHandler::connectToVhal(void) {
|
||||
|
||||
bool returnValue = false;
|
||||
|
||||
{
|
||||
Mutex::Autolock lock(mMutex);
|
||||
if (mVhalService.get() != nullptr) {
|
||||
return true;
|
||||
}
|
||||
}
|
||||
|
||||
// Get a vehicle HAL instance.
|
||||
sp<IVehicle> vhalService = IVehicle::tryGetService();
|
||||
if (vhalService.get() == nullptr) {
|
||||
LOC_LOGe("Unable to connect to VHAL Service.");
|
||||
return returnValue;
|
||||
}
|
||||
|
||||
auto ret = vhalService->linkToDeath(mVHidlDeathRecipient, /*cookie=*/0x03);
|
||||
if (!ret.isOk() || ret == false) {
|
||||
LOC_LOGw("Failed to connect to VHAL. VHAL is dead.");
|
||||
return returnValue;
|
||||
}
|
||||
{
|
||||
Mutex::Autolock lock(mMutex);
|
||||
mVhalService = vhalService;
|
||||
}
|
||||
LOC_LOGi("Connected to VHAL");
|
||||
returnValue = subscribeToVhal();
|
||||
return returnValue;
|
||||
}//initializeGnssAutoPower
|
||||
|
||||
void GnssAutoPowerHandler::handleGnssAutoPowerEvent(int32_t powerState) {
|
||||
|
||||
bool retVal = false;
|
||||
LOC_LOGd("Power State: %d", powerState);
|
||||
|
||||
switch (powerState) {
|
||||
case POWER_STATE_SHUTDOWN_PREPARE:
|
||||
LOC_LOGi("Suspend GNSS sessions.");
|
||||
sendPowerEventToLocCtrlApi(POWER_STATE_SUSPEND);
|
||||
break;
|
||||
case POWER_STATE_DEEP_SLEEP_EXIT:
|
||||
case POWER_STATE_SHUTDOWN_CANCELLED:
|
||||
LOC_LOGi("Resume GNSS Sessions.");
|
||||
sendPowerEventToLocCtrlApi(POWER_STATE_RESUME);
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}//switch
|
||||
} //GnssAutoPowerHandler::handleGnssAutoPowerEvent
|
||||
|
||||
void GnssAutoPowerHandler::handleVHidlDeath(uint64_t cookie, const wp<IBase>& who) {
|
||||
|
||||
{
|
||||
LOC_LOGE("%s] VHAL service died. cookie: %llu, who: %p",
|
||||
__FUNCTION__, static_cast<unsigned long long>(cookie), &who);
|
||||
|
||||
Mutex::Autolock lock(mMutex);
|
||||
if (mVhalService.get() != nullptr) {
|
||||
mVhalService->unlinkToDeath(mVHidlDeathRecipient);
|
||||
mVhalService = nullptr;
|
||||
}
|
||||
}
|
||||
|
||||
(void) cookie;
|
||||
//TBD: To re-connect to VHAL service
|
||||
|
||||
} //handleVHidlDeath
|
||||
|
||||
|
||||
/*Overrides*/
|
||||
|
||||
Return<void> GnssAutoPowerHandler::onPropertyEvent(const hidl_vec<VehiclePropValue>& ) {
|
||||
return Return<void>();
|
||||
}
|
||||
|
||||
Return<void> GnssAutoPowerHandler::onPropertySet(const VehiclePropValue& propValue) {
|
||||
|
||||
if (propValue.prop == static_cast<int32_t>(VehicleProperty::AP_POWER_STATE_REPORT))
|
||||
{
|
||||
int32_t powerState = propValue.value.int32Values[0];
|
||||
handleGnssAutoPowerEvent(powerState);
|
||||
}
|
||||
return Return<void>();
|
||||
}
|
||||
|
||||
Return<void> GnssAutoPowerHandler::onPropertySetError(StatusCode status, int32_t propId,
|
||||
int32_t areaId) {
|
||||
(void)status;
|
||||
(void)propId;
|
||||
(void)areaId;
|
||||
return Return<void>();
|
||||
}
|
||||
|
||||
|
||||
GnssAutoPowerHandler* GnssAutoPowerHandler::getGnssAutoPowerHandler() {
|
||||
|
||||
if (nullptr == sGnssAutoPowerHandler) {
|
||||
|
||||
GnssAutoPowerHandler *autoPwrHandler;
|
||||
autoPwrHandler = new GnssAutoPowerHandler();
|
||||
}
|
||||
|
||||
return sGnssAutoPowerHandler;
|
||||
}
|
||||
|
||||
extern "C" void initGnssAutoPowerHandler(void){
|
||||
|
||||
GnssAutoPowerHandler::getGnssAutoPowerHandler();
|
||||
}
|
||||
100
gps/android/auto_power/GnssAutoPowerHandler.h
Normal file
100
gps/android/auto_power/GnssAutoPowerHandler.h
Normal file
@@ -0,0 +1,100 @@
|
||||
/*
|
||||
* Copyright (c) 2021 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.
|
||||
*/
|
||||
#ifndef GNSSAUTOPOWERHANDLER_H
|
||||
#define GNSSAUTOPOWERHANDLER_H
|
||||
|
||||
#include <utils/StrongPointer.h>
|
||||
#include <utils/RefBase.h>
|
||||
#include <android/hardware/automotive/vehicle/2.0/IVehicle.h>
|
||||
#include <unordered_map>
|
||||
#include <dlfcn.h>
|
||||
#include <LocationAPI.h>
|
||||
|
||||
|
||||
using ::android::hardware::Return;
|
||||
using ::android::hardware::Void;
|
||||
using ::android::hardware::hidl_death_recipient;
|
||||
using ::android::sp;
|
||||
using ::android::wp;
|
||||
using ::android::hidl::base::V1_0::IBase;
|
||||
using ::android::hardware::automotive::vehicle::V2_0::IVehicleCallback;
|
||||
using ::android::hardware::hidl_vec;
|
||||
using ::android::hardware::automotive::vehicle::V2_0::VehiclePropValue;
|
||||
using ::android::hardware::automotive::vehicle::V2_0::StatusCode;
|
||||
using ::android::hardware::automotive::vehicle::V2_0::IVehicle;
|
||||
using ::android::hardware::automotive::vehicle::V2_0::SubscribeFlags;
|
||||
using ::android::hardware::automotive::vehicle::V2_0::SubscribeOptions;
|
||||
using ::android::hardware::automotive::vehicle::V2_0::VehicleApPowerStateReport;
|
||||
using ::android::hardware::automotive::vehicle::V2_0::VehiclePropConfig;
|
||||
using ::android::hardware::automotive::vehicle::V2_0::VehicleProperty;
|
||||
using ::android::hardware::automotive::vehicle::V2_0::VehiclePropValue;
|
||||
|
||||
class GnssAutoPowerHandler : public IVehicleCallback {
|
||||
|
||||
public:
|
||||
GnssAutoPowerHandler();
|
||||
~GnssAutoPowerHandler();
|
||||
|
||||
/* Overrides */
|
||||
Return<void> onPropertyEvent(const hidl_vec<VehiclePropValue>& propValues) override;
|
||||
Return<void> onPropertySet(const VehiclePropValue& propValue) override;
|
||||
Return<void> onPropertySetError(StatusCode errorCode, int32_t propId,
|
||||
int32_t areaId) override;
|
||||
|
||||
void handleVHidlDeath(uint64_t cookie, const wp<IBase>& who);
|
||||
|
||||
static GnssAutoPowerHandler* getGnssAutoPowerHandler();
|
||||
void sendPowerEventToLocCtrlApi(PowerStateType intPowerState);
|
||||
bool connectToVhal();
|
||||
void initializeGnssAutoPower();
|
||||
void handleGnssAutoPowerEvent(int32_t powerState);
|
||||
bool subscribeToVhal();
|
||||
bool isPropertySupported(int32_t prop);
|
||||
private:
|
||||
struct VHidlDeathRecipient : public hidl_death_recipient {
|
||||
public:
|
||||
explicit VHidlDeathRecipient(const android::sp<GnssAutoPowerHandler>& handler)
|
||||
: mHandler(handler) {
|
||||
}
|
||||
~VHidlDeathRecipient() = default;
|
||||
void serviceDied(uint64_t cookie,
|
||||
const wp<IBase>& who) override;
|
||||
private:
|
||||
sp<GnssAutoPowerHandler> mHandler;
|
||||
}; //VHidlDeathRecipient
|
||||
|
||||
android::Mutex mMutex;
|
||||
std::unordered_map<int32_t, bool> mSupportedProperties;
|
||||
sp<VHidlDeathRecipient> mVHidlDeathRecipient;
|
||||
sp<IVehicle> mVhalService GUARDED_BY(mMutex);
|
||||
LocationControlAPI *mLocationControlApi;
|
||||
|
||||
}; //class PowerStateHandler
|
||||
|
||||
#endif //GNSSAUTOPOWERHANDLER_H
|
||||
Reference in New Issue
Block a user