2010-11-12 01:58:51 +00:00
|
|
|
/*
|
|
|
|
* Copyright (C) 2010 The Android Open Source Project
|
|
|
|
*
|
|
|
|
* Licensed under the Apache License, Version 2.0 (the "License");
|
|
|
|
* you may not use this file except in compliance with the License.
|
|
|
|
* You may obtain a copy of the License at
|
|
|
|
*
|
|
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
|
|
|
*
|
|
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
|
|
* distributed under the License is distributed on an "AS IS" BASIS,
|
|
|
|
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
|
|
* See the License for the specific language governing permissions and
|
|
|
|
* limitations under the License.
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <stdint.h>
|
|
|
|
#include <math.h>
|
|
|
|
#include <sys/types.h>
|
|
|
|
|
|
|
|
#include <utils/Atomic.h>
|
|
|
|
#include <utils/Errors.h>
|
|
|
|
#include <utils/Singleton.h>
|
|
|
|
|
|
|
|
#include <binder/BinderService.h>
|
|
|
|
#include <binder/Parcel.h>
|
|
|
|
#include <binder/IServiceManager.h>
|
|
|
|
|
|
|
|
#include <hardware/sensors.h>
|
|
|
|
|
|
|
|
#include "SensorDevice.h"
|
2011-05-27 23:23:58 +00:00
|
|
|
#include "SensorService.h"
|
2010-11-12 01:58:51 +00:00
|
|
|
|
|
|
|
namespace android {
|
|
|
|
// ---------------------------------------------------------------------------
|
|
|
|
class BatteryService : public Singleton<BatteryService> {
|
|
|
|
static const int TRANSACTION_noteStartSensor = IBinder::FIRST_CALL_TRANSACTION + 3;
|
|
|
|
static const int TRANSACTION_noteStopSensor = IBinder::FIRST_CALL_TRANSACTION + 4;
|
|
|
|
static const String16 DESCRIPTOR;
|
|
|
|
|
|
|
|
friend class Singleton<BatteryService>;
|
|
|
|
sp<IBinder> mBatteryStatService;
|
|
|
|
|
|
|
|
BatteryService() {
|
|
|
|
const sp<IServiceManager> sm(defaultServiceManager());
|
|
|
|
if (sm != NULL) {
|
|
|
|
const String16 name("batteryinfo");
|
|
|
|
mBatteryStatService = sm->getService(name);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
status_t noteStartSensor(int uid, int handle) {
|
|
|
|
Parcel data, reply;
|
|
|
|
data.writeInterfaceToken(DESCRIPTOR);
|
|
|
|
data.writeInt32(uid);
|
|
|
|
data.writeInt32(handle);
|
|
|
|
status_t err = mBatteryStatService->transact(
|
|
|
|
TRANSACTION_noteStartSensor, data, &reply, 0);
|
|
|
|
err = reply.readExceptionCode();
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
status_t noteStopSensor(int uid, int handle) {
|
|
|
|
Parcel data, reply;
|
|
|
|
data.writeInterfaceToken(DESCRIPTOR);
|
|
|
|
data.writeInt32(uid);
|
|
|
|
data.writeInt32(handle);
|
|
|
|
status_t err = mBatteryStatService->transact(
|
|
|
|
TRANSACTION_noteStopSensor, data, &reply, 0);
|
|
|
|
err = reply.readExceptionCode();
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
public:
|
|
|
|
void enableSensor(int handle) {
|
|
|
|
if (mBatteryStatService != 0) {
|
|
|
|
int uid = IPCThreadState::self()->getCallingUid();
|
|
|
|
int64_t identity = IPCThreadState::self()->clearCallingIdentity();
|
|
|
|
noteStartSensor(uid, handle);
|
|
|
|
IPCThreadState::self()->restoreCallingIdentity(identity);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
void disableSensor(int handle) {
|
|
|
|
if (mBatteryStatService != 0) {
|
|
|
|
int uid = IPCThreadState::self()->getCallingUid();
|
|
|
|
int64_t identity = IPCThreadState::self()->clearCallingIdentity();
|
|
|
|
noteStopSensor(uid, handle);
|
|
|
|
IPCThreadState::self()->restoreCallingIdentity(identity);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
};
|
|
|
|
|
|
|
|
const String16 BatteryService::DESCRIPTOR("com.android.internal.app.IBatteryStats");
|
|
|
|
|
|
|
|
ANDROID_SINGLETON_STATIC_INSTANCE(BatteryService)
|
|
|
|
|
|
|
|
// ---------------------------------------------------------------------------
|
|
|
|
|
|
|
|
ANDROID_SINGLETON_STATIC_INSTANCE(SensorDevice)
|
|
|
|
|
|
|
|
SensorDevice::SensorDevice()
|
|
|
|
: mSensorDevice(0),
|
|
|
|
mSensorModule(0)
|
|
|
|
{
|
|
|
|
status_t err = hw_get_module(SENSORS_HARDWARE_MODULE_ID,
|
|
|
|
(hw_module_t const**)&mSensorModule);
|
|
|
|
|
|
|
|
LOGE_IF(err, "couldn't load %s module (%s)",
|
|
|
|
SENSORS_HARDWARE_MODULE_ID, strerror(-err));
|
|
|
|
|
|
|
|
if (mSensorModule) {
|
|
|
|
err = sensors_open(&mSensorModule->common, &mSensorDevice);
|
|
|
|
|
|
|
|
LOGE_IF(err, "couldn't open device for module %s (%s)",
|
|
|
|
SENSORS_HARDWARE_MODULE_ID, strerror(-err));
|
|
|
|
|
|
|
|
if (mSensorDevice) {
|
|
|
|
sensor_t const* list;
|
|
|
|
ssize_t count = mSensorModule->get_sensors_list(mSensorModule, &list);
|
|
|
|
mActivationCount.setCapacity(count);
|
|
|
|
Info model;
|
|
|
|
for (size_t i=0 ; i<size_t(count) ; i++) {
|
|
|
|
mActivationCount.add(list[i].handle, model);
|
|
|
|
mSensorDevice->activate(mSensorDevice, list[i].handle, 0);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
void SensorDevice::dump(String8& result, char* buffer, size_t SIZE)
|
|
|
|
{
|
|
|
|
if (!mSensorModule) return;
|
|
|
|
sensor_t const* list;
|
|
|
|
ssize_t count = mSensorModule->get_sensors_list(mSensorModule, &list);
|
|
|
|
|
|
|
|
snprintf(buffer, SIZE, "%d h/w sensors:\n", int(count));
|
|
|
|
result.append(buffer);
|
|
|
|
|
|
|
|
Mutex::Autolock _l(mLock);
|
|
|
|
for (size_t i=0 ; i<size_t(count) ; i++) {
|
2011-09-14 23:43:34 +00:00
|
|
|
const Info& info = mActivationCount.valueFor(list[i].handle);
|
|
|
|
snprintf(buffer, SIZE, "handle=0x%08x, active-count=%d, rates(ms)={ ",
|
2010-11-12 01:58:51 +00:00
|
|
|
list[i].handle,
|
2011-09-14 23:43:34 +00:00
|
|
|
info.rates.size());
|
|
|
|
result.append(buffer);
|
|
|
|
for (size_t j=0 ; j<info.rates.size() ; j++) {
|
|
|
|
snprintf(buffer, SIZE, "%4.1f%s",
|
|
|
|
info.rates.valueAt(j) / 1e6f,
|
|
|
|
j<info.rates.size()-1 ? ", " : "");
|
|
|
|
result.append(buffer);
|
|
|
|
}
|
|
|
|
snprintf(buffer, SIZE, " }, selected=%4.1f ms\n", info.delay / 1e6f);
|
2010-11-12 01:58:51 +00:00
|
|
|
result.append(buffer);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
ssize_t SensorDevice::getSensorList(sensor_t const** list) {
|
|
|
|
if (!mSensorModule) return NO_INIT;
|
|
|
|
ssize_t count = mSensorModule->get_sensors_list(mSensorModule, list);
|
|
|
|
return count;
|
|
|
|
}
|
|
|
|
|
|
|
|
status_t SensorDevice::initCheck() const {
|
|
|
|
return mSensorDevice && mSensorModule ? NO_ERROR : NO_INIT;
|
|
|
|
}
|
|
|
|
|
|
|
|
ssize_t SensorDevice::poll(sensors_event_t* buffer, size_t count) {
|
|
|
|
if (!mSensorDevice) return NO_INIT;
|
2011-11-10 01:50:15 +00:00
|
|
|
ssize_t c;
|
|
|
|
do {
|
|
|
|
c = mSensorDevice->poll(mSensorDevice, buffer, count);
|
|
|
|
} while (c == -EINTR);
|
|
|
|
return c;
|
2010-11-12 01:58:51 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
status_t SensorDevice::activate(void* ident, int handle, int enabled)
|
|
|
|
{
|
|
|
|
if (!mSensorDevice) return NO_INIT;
|
|
|
|
status_t err(NO_ERROR);
|
|
|
|
bool actuateHardware = false;
|
|
|
|
|
|
|
|
Info& info( mActivationCount.editValueFor(handle) );
|
2011-05-27 23:23:58 +00:00
|
|
|
|
|
|
|
|
2011-12-20 16:23:08 +00:00
|
|
|
ALOGD_IF(DEBUG_CONNECTIONS,
|
2011-05-27 23:23:58 +00:00
|
|
|
"SensorDevice::activate: ident=%p, handle=0x%08x, enabled=%d, count=%d",
|
|
|
|
ident, handle, enabled, info.rates.size());
|
|
|
|
|
2010-11-12 01:58:51 +00:00
|
|
|
if (enabled) {
|
|
|
|
Mutex::Autolock _l(mLock);
|
2011-12-20 16:23:08 +00:00
|
|
|
ALOGD_IF(DEBUG_CONNECTIONS, "... index=%ld",
|
2011-05-27 23:23:58 +00:00
|
|
|
info.rates.indexOfKey(ident));
|
|
|
|
|
2010-11-12 01:58:51 +00:00
|
|
|
if (info.rates.indexOfKey(ident) < 0) {
|
|
|
|
info.rates.add(ident, DEFAULT_EVENTS_PERIOD);
|
2011-05-27 23:23:58 +00:00
|
|
|
if (info.rates.size() == 1) {
|
|
|
|
actuateHardware = true;
|
|
|
|
}
|
2010-11-30 01:26:51 +00:00
|
|
|
} else {
|
|
|
|
// sensor was already activated for this ident
|
2010-11-12 01:58:51 +00:00
|
|
|
}
|
2010-11-30 01:26:51 +00:00
|
|
|
} else {
|
2010-11-12 01:58:51 +00:00
|
|
|
Mutex::Autolock _l(mLock);
|
2011-12-20 16:23:08 +00:00
|
|
|
ALOGD_IF(DEBUG_CONNECTIONS, "... index=%ld",
|
2011-05-27 23:23:58 +00:00
|
|
|
info.rates.indexOfKey(ident));
|
|
|
|
|
|
|
|
ssize_t idx = info.rates.removeItem(ident);
|
|
|
|
if (idx >= 0) {
|
2010-11-30 01:26:51 +00:00
|
|
|
if (info.rates.size() == 0) {
|
|
|
|
actuateHardware = true;
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
// sensor wasn't enabled for this ident
|
|
|
|
}
|
2010-11-12 01:58:51 +00:00
|
|
|
}
|
2010-11-30 01:26:51 +00:00
|
|
|
|
2010-11-12 01:58:51 +00:00
|
|
|
if (actuateHardware) {
|
2011-12-20 16:23:08 +00:00
|
|
|
ALOGD_IF(DEBUG_CONNECTIONS, "\t>>> actuating h/w");
|
2011-05-27 23:23:58 +00:00
|
|
|
|
2010-11-12 01:58:51 +00:00
|
|
|
err = mSensorDevice->activate(mSensorDevice, handle, enabled);
|
|
|
|
if (enabled) {
|
|
|
|
LOGE_IF(err, "Error activating sensor %d (%s)", handle, strerror(-err));
|
|
|
|
if (err == 0) {
|
|
|
|
BatteryService::getInstance().enableSensor(handle);
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
if (err == 0) {
|
|
|
|
BatteryService::getInstance().disableSensor(handle);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2011-09-14 23:43:34 +00:00
|
|
|
{ // scope for the lock
|
2010-11-12 01:58:51 +00:00
|
|
|
Mutex::Autolock _l(mLock);
|
2011-09-14 23:43:34 +00:00
|
|
|
nsecs_t ns = info.selectDelay();
|
2010-11-12 01:58:51 +00:00
|
|
|
mSensorDevice->setDelay(mSensorDevice, handle, ns);
|
|
|
|
}
|
|
|
|
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
status_t SensorDevice::setDelay(void* ident, int handle, int64_t ns)
|
|
|
|
{
|
|
|
|
if (!mSensorDevice) return NO_INIT;
|
2011-09-14 23:43:34 +00:00
|
|
|
Mutex::Autolock _l(mLock);
|
2010-11-12 01:58:51 +00:00
|
|
|
Info& info( mActivationCount.editValueFor(handle) );
|
2011-09-14 23:43:34 +00:00
|
|
|
status_t err = info.setDelayForIdent(ident, ns);
|
|
|
|
if (err < 0) return err;
|
|
|
|
ns = info.selectDelay();
|
|
|
|
return mSensorDevice->setDelay(mSensorDevice, handle, ns);
|
|
|
|
}
|
2011-05-18 05:54:42 +00:00
|
|
|
|
2011-09-14 23:43:34 +00:00
|
|
|
// ---------------------------------------------------------------------------
|
2011-05-18 05:54:42 +00:00
|
|
|
|
2011-09-14 23:43:34 +00:00
|
|
|
status_t SensorDevice::Info::setDelayForIdent(void* ident, int64_t ns)
|
|
|
|
{
|
|
|
|
ssize_t index = rates.indexOfKey(ident);
|
|
|
|
if (index < 0) {
|
|
|
|
LOGE("Info::setDelayForIdent(ident=%p, ns=%lld) failed (%s)",
|
|
|
|
ident, ns, strerror(-index));
|
|
|
|
return BAD_INDEX;
|
|
|
|
}
|
|
|
|
rates.editValueAt(index) = ns;
|
|
|
|
return NO_ERROR;
|
|
|
|
}
|
|
|
|
|
|
|
|
nsecs_t SensorDevice::Info::selectDelay()
|
|
|
|
{
|
|
|
|
nsecs_t ns = rates.valueAt(0);
|
|
|
|
for (size_t i=1 ; i<rates.size() ; i++) {
|
|
|
|
nsecs_t cur = rates.valueAt(i);
|
|
|
|
if (cur < ns) {
|
|
|
|
ns = cur;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
delay = ns;
|
|
|
|
return ns;
|
2010-11-12 01:58:51 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
// ---------------------------------------------------------------------------
|
|
|
|
}; // namespace android
|
|
|
|
|