1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
|
// Copyright (C) 2019 BogDan Vatra <bogdan@kde.org>
// SPDX-License-Identifier: LicenseRef-Qt-Commercial OR LGPL-3.0-only OR GPL-2.0-only OR GPL-3.0-only
#ifndef SENSOREVENTQUEUE_H
#define SENSOREVENTQUEUE_H
#include "sensormanager.h"
#include <functional>
#include <QCoreApplication>
#include <QEvent>
#include <QSensorBackend>
class FunctionEvent : public QEvent
{
public:
using Function = std::function<void()>;
enum {
FunctionEventType = User + 1
};
explicit FunctionEvent(const Function &function)
: QEvent(Type(FunctionEventType))
, m_function(function)
{}
void callFunction() const
{
m_function();
}
private:
Function m_function;
};
class ThreadSafeSensorBackend : public QSensorBackend
{
public:
ThreadSafeSensorBackend(QSensor *sensor, QObject *parent = nullptr)
: QSensorBackend(sensor, parent)
, m_sensorManager(SensorManager::instance())
{}
// QObject interface
bool event(QEvent *event) override
{
if (event->type() == FunctionEvent::FunctionEventType) {
static_cast<FunctionEvent*>(event)->callFunction();
event->accept();
return true;
}
return QSensorBackend::event(event);
}
protected:
QSharedPointer<SensorManager> m_sensorManager;
};
template <typename T>
class SensorEventQueue : public ThreadSafeSensorBackend
{
public:
explicit SensorEventQueue(int androidSensorType, QSensor *sensor, QObject *parent = nullptr)
: ThreadSafeSensorBackend(sensor, parent)
{
setReading<T>(&m_reader);
m_sensorEventQueue = ASensorManager_createEventQueue(m_sensorManager->manager(), m_sensorManager->looper(), -1, &looperCallback, this);
setSensorType(androidSensorType);
}
~SensorEventQueue() override
{
stop();
ASensorManager_destroyEventQueue(m_sensorManager->manager(), m_sensorEventQueue);
}
void setSensorType(int type)
{
bool started = m_started;
if (started)
stop();
m_sensor = ASensorManager_getDefaultSensor(m_sensorManager->manager(), type);
setDescription(m_sensorManager->description(m_sensor));
if (started)
start();
}
// QSensorBackend interface
void start() override
{
ASensorEventQueue_enableSensor(m_sensorEventQueue, m_sensor);
// The QSensor datarate is in Hz (frequency), whereas the setEventRate expects microseconds
if (sensor()->dataRate() > 0)
ASensorEventQueue_setEventRate(m_sensorEventQueue, m_sensor, std::max(ASensor_getMinDelay(m_sensor), 1000000/sensor()->dataRate()));
m_started = true;
}
void stop() override
{
ASensorEventQueue_disableSensor(m_sensorEventQueue, m_sensor);
m_started = false;
}
bool isFeatureSupported(QSensor::Feature feature) const override
{
switch (feature) {
case QSensor::SkipDuplicates:
return true;
default:
return false;
}
}
protected:
virtual void dataReceived(const ASensorEvent &event) = 0;
static int looperCallback(int /*fd*/, int /*events*/, void* data)
{
ASensorEvent sensorEvent;
auto self = reinterpret_cast<SensorEventQueue*>(data);
while (ASensorEventQueue_getEvents(self->m_sensorEventQueue, &sensorEvent, 1))
QCoreApplication::postEvent(self, new FunctionEvent{[=]{self->dataReceived(sensorEvent);}});
return 1; // 1 means keep receiving events
}
protected:
T m_reader;
const ASensor *m_sensor = nullptr;
ASensorEventQueue* m_sensorEventQueue = nullptr;
bool m_started = false;
};
#endif // SENSOREVENTQUEUE_H
|
