Bug fix for SensorFusion data rate.
SensorFusion is always returning data at the slowest possible sampling rate (5 Hz). batch() is getting called twice, first time with the requested rate and second time with the slowest rate (which overwrites the requested rate). Fix batch call in SensorFusion::activate()
Bug: 12064319
Change-Id: If62f3e514233f69810336fd22b136b4395b667d3
(cherry picked from commit 8850909038
)
This commit is contained in:
parent
4b84704b97
commit
19d6481956
@ -102,15 +102,6 @@ status_t SensorFusion::activate(void* ident, bool enabled) {
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
if (enabled) {
|
|
||||||
ALOGD_IF(DEBUG_CONNECTIONS, "SensorFusion calling batch ident=%p ", ident);
|
|
||||||
// Activating a sensor in continuous mode is equivalent to calling batch with the default
|
|
||||||
// period and timeout equal to ZERO, followed by a call to activate.
|
|
||||||
mSensorDevice.batch(ident, mAcc.getHandle(), 0, DEFAULT_EVENTS_PERIOD, 0);
|
|
||||||
mSensorDevice.batch(ident, mMag.getHandle(), 0, DEFAULT_EVENTS_PERIOD, 0);
|
|
||||||
mSensorDevice.batch(ident, mGyro.getHandle(), 0, DEFAULT_EVENTS_PERIOD, 0);
|
|
||||||
}
|
|
||||||
|
|
||||||
mSensorDevice.activate(ident, mAcc.getHandle(), enabled);
|
mSensorDevice.activate(ident, mAcc.getHandle(), enabled);
|
||||||
mSensorDevice.activate(ident, mMag.getHandle(), enabled);
|
mSensorDevice.activate(ident, mMag.getHandle(), enabled);
|
||||||
mSensorDevice.activate(ident, mGyro.getHandle(), enabled);
|
mSensorDevice.activate(ident, mGyro.getHandle(), enabled);
|
||||||
@ -127,9 +118,10 @@ status_t SensorFusion::activate(void* ident, bool enabled) {
|
|||||||
}
|
}
|
||||||
|
|
||||||
status_t SensorFusion::setDelay(void* ident, int64_t ns) {
|
status_t SensorFusion::setDelay(void* ident, int64_t ns) {
|
||||||
mSensorDevice.setDelay(ident, mAcc.getHandle(), ns);
|
// Call batch with timeout zero instead of setDelay().
|
||||||
mSensorDevice.setDelay(ident, mMag.getHandle(), ms2ns(20));
|
mSensorDevice.batch(ident, mAcc.getHandle(), 0, ns, 0);
|
||||||
mSensorDevice.setDelay(ident, mGyro.getHandle(), mTargetDelayNs);
|
mSensorDevice.batch(ident, mMag.getHandle(), 0, ms2ns(20), 0);
|
||||||
|
mSensorDevice.batch(ident, mGyro.getHandle(), 0, mTargetDelayNs, 0);
|
||||||
return NO_ERROR;
|
return NO_ERROR;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -37,7 +37,6 @@ class SensorDevice;
|
|||||||
|
|
||||||
class SensorFusion : public Singleton<SensorFusion> {
|
class SensorFusion : public Singleton<SensorFusion> {
|
||||||
friend class Singleton<SensorFusion>;
|
friend class Singleton<SensorFusion>;
|
||||||
static const nsecs_t DEFAULT_EVENTS_PERIOD = 200000000; // 5 Hz
|
|
||||||
|
|
||||||
SensorDevice& mSensorDevice;
|
SensorDevice& mSensorDevice;
|
||||||
Sensor mAcc;
|
Sensor mAcc;
|
||||||
|
Loading…
Reference in New Issue
Block a user