1 | /**************************************************************************** |
2 | ** |
3 | ** Copyright (C) 2016 The Qt Company Ltd. |
4 | ** Contact: https://www.qt.io/licensing/ |
5 | ** |
6 | ** This file is part of the QtSensors module of the Qt Toolkit. |
7 | ** |
8 | ** $QT_BEGIN_LICENSE:GPL-EXCEPT$ |
9 | ** Commercial License Usage |
10 | ** Licensees holding valid commercial Qt licenses may use this file in |
11 | ** accordance with the commercial license agreement provided with the |
12 | ** Software or, alternatively, in accordance with the terms contained in |
13 | ** a written agreement between you and The Qt Company. For licensing terms |
14 | ** and conditions see https://www.qt.io/terms-conditions. For further |
15 | ** information use the contact form at https://www.qt.io/contact-us. |
16 | ** |
17 | ** GNU General Public License Usage |
18 | ** Alternatively, this file may be used under the terms of the GNU |
19 | ** General Public License version 3 as published by the Free Software |
20 | ** Foundation with exceptions as appearing in the file LICENSE.GPL3-EXCEPT |
21 | ** included in the packaging of this file. Please review the following |
22 | ** information to ensure the GNU General Public License requirements will |
23 | ** be met: https://www.gnu.org/licenses/gpl-3.0.html. |
24 | ** |
25 | ** $QT_END_LICENSE$ |
26 | ** |
27 | ****************************************************************************/ |
28 | |
29 | #include <QTimer> |
30 | #include <QDebug> |
31 | #include <QCoreApplication> |
32 | #include "mockcommon.h" |
33 | |
34 | Q_GLOBAL_STATIC(mockcommonPrivate, mockcommonPrv) |
35 | |
36 | mockcommonPrivate *mockcommonPrivate::instance() |
37 | { |
38 | return mockcommonPrv(); |
39 | } |
40 | |
41 | mockcommonPrivate::mockcommonPrivate() |
42 | : QObject(),prevts(50), firstRun(0) |
43 | { |
44 | readTimer = new QTimer(this); |
45 | readTimer->setSingleShot(true); |
46 | connect(sender: readTimer,SIGNAL(timeout()),receiver: this,SLOT(timerout())); |
47 | } |
48 | |
49 | void mockcommonPrivate::timerout() |
50 | { |
51 | while (pFile.isOpen() && !pFile.atEnd()) { |
52 | QString line = pFile.readLine(); |
53 | if (!line.isNull()) { |
54 | if (parseData(line)) { |
55 | readTimer->start(); |
56 | break; |
57 | } |
58 | } |
59 | } |
60 | } |
61 | |
62 | bool mockcommonPrivate::setFile(const QString &filename) |
63 | { |
64 | if (filename.isEmpty()) |
65 | return false; |
66 | |
67 | if (pFile.isOpen()) { |
68 | pFile.close(); |
69 | } |
70 | oldAccelTs = 0; |
71 | firstRun = true; |
72 | pFile.setFileName(QCoreApplication::instance()->applicationDirPath() + "/" + filename); |
73 | bool ok = pFile.open(flags: QIODevice::ReadOnly); |
74 | if (!ok) { |
75 | pFile.setFileName(SRCDIR "/" + filename); |
76 | ok = pFile.open(flags: QIODevice::ReadOnly); |
77 | } |
78 | return ok; |
79 | } |
80 | |
81 | bool mockcommonPrivate::parseData(const QString &line) |
82 | { |
83 | bool ok = false; |
84 | QString sensorToken = line.section(in_sep: QLatin1String(":" ),start: 0, end: 0).trimmed(); |
85 | QString data = line.section(in_sep: QLatin1String(":" ),start: 1, end: 1).trimmed(); |
86 | |
87 | if (sensorToken == QLatin1String("accelerometer" )) { |
88 | if (!firstRun) { |
89 | |
90 | Q_EMIT accelData(data); |
91 | if (prevts == 0 || prevts > 90000 ) |
92 | prevts = 20000; // use 20 Hz |
93 | if (prevts > 90000 ) // original slam timestamps are wrong |
94 | prevts = 100000; //use 100 Hz |
95 | readTimer->setInterval((int)prevts/1000); |
96 | } else { |
97 | firstRun = false; |
98 | } |
99 | quint64 ts = data.section(in_sep: QLatin1String("," ), start: 0,end: 0).toULongLong(); |
100 | ok = true; |
101 | qreal difference; |
102 | if (oldAccelTs == 0) { |
103 | oldAccelTs = ts; |
104 | } |
105 | difference = ts - oldAccelTs; |
106 | |
107 | if (difference < 1 |
108 | || difference == ts) { |
109 | int hertz = 50; |
110 | readTimer->setInterval((1.0/hertz)*1000); |
111 | } else { |
112 | if (firstRun) |
113 | readTimer->setInterval((int)difference/1000); |
114 | } |
115 | oldAccelTs = ts; |
116 | prevts = difference; |
117 | |
118 | } else if (sensorToken == QLatin1String("irProximity" )) { |
119 | Q_EMIT irProxyData(data); |
120 | } else if (sensorToken == QLatin1String("orientation" )) { |
121 | Q_EMIT orientData(data); |
122 | } else if (sensorToken == QLatin1String("tap" )) { |
123 | Q_EMIT tapData(data); //just send this it takes only one to be detected |
124 | } else if (sensorToken == QLatin1String("proximity" )) { |
125 | Q_EMIT proxyData(data); |
126 | } |
127 | return ok; |
128 | } |
129 | |
130 | |
131 | mockcommon::mockcommon(QSensor *sensor) |
132 | : QSensorBackend(sensor), timer(0) |
133 | { |
134 | mockcommonPrv()->readTimer->setInterval(0); |
135 | } |
136 | |
137 | void mockcommon::start() |
138 | { |
139 | if (!mockcommonPrv()->readTimer->isActive()) { |
140 | mockcommonPrv()->readTimer->start(); |
141 | } |
142 | } |
143 | |
144 | void mockcommon::stop() |
145 | { |
146 | if (mockcommonPrv()->readTimer->isActive()) { |
147 | mockcommonPrv()->readTimer->stop(); |
148 | } |
149 | } |
150 | |
151 | char const * const mockaccelerometer::id("mock.accelerometer" ); |
152 | |
153 | mockaccelerometer::mockaccelerometer(QSensor *sensor) |
154 | : mockcommon(sensor) |
155 | { |
156 | setReading<QAccelerometerReading>(&m_reading); |
157 | addDataRate(min: 50, max: 50); // 50 |
158 | |
159 | connect(sender: mockcommonPrv(),SIGNAL(accelData(QString)),receiver: this,SLOT(parseAccelData(QString))); |
160 | } |
161 | |
162 | void mockaccelerometer::parseAccelData(const QString &data) |
163 | { |
164 | quint64 ts = data.section(in_sep: QLatin1String("," ), start: 0,end: 0).toULongLong(); |
165 | m_reading.setTimestamp(ts); |
166 | m_reading.setX(data.section(in_sep: QLatin1String("," ), start: 1,end: 1).toDouble()); |
167 | m_reading.setY(data.section(in_sep: QLatin1String("," ), start: 2,end: 2).toDouble()); |
168 | m_reading.setZ(data.section(in_sep: QLatin1String("," ), start: 3,end: 3).toDouble()); |
169 | newReadingAvailable(); |
170 | } |
171 | |
172 | char const * const mockorientationsensor::id("mock.orientation" ); |
173 | |
174 | mockorientationsensor::mockorientationsensor(QSensor *sensor) |
175 | : mockcommon(sensor) |
176 | { |
177 | setReading<QOrientationReading>(&m_reading); |
178 | addDataRate(min: 50, max: 50); // 50Hz |
179 | connect(sender: mockcommonPrv(),SIGNAL(orientData(QString)),receiver: this,SLOT(parseOrientData(QString))); |
180 | } |
181 | |
182 | void mockorientationsensor::parseOrientData(const QString &data) |
183 | { |
184 | m_reading.setTimestamp(data.section(in_sep: QLatin1String("," ), start: 0,end: 0).toULongLong()); |
185 | m_reading.setOrientation(static_cast<QOrientationReading::Orientation>(data.section(in_sep: QLatin1String("," ), start: 1,end: 1).toInt())); |
186 | |
187 | newReadingAvailable(); |
188 | } |
189 | |
190 | char const * const mockirproximitysensor::id("mock.irproximity" ); |
191 | |
192 | mockirproximitysensor::mockirproximitysensor(QSensor *sensor) |
193 | : mockcommon(sensor) |
194 | { |
195 | setReading<QIRProximityReading>(&m_reading); |
196 | addDataRate(min: 50, max: 50); // 50Hz |
197 | connect(sender: mockcommonPrv(),SIGNAL(irProxyData(QString)),receiver: this,SLOT(parseIrProxyData(QString))); |
198 | } |
199 | |
200 | void mockirproximitysensor::parseIrProxyData(const QString &data) |
201 | { |
202 | m_reading.setTimestamp(data.section(in_sep: QLatin1String("," ), start: 0,end: 0).toULongLong()); |
203 | m_reading.setReflectance(data.section(in_sep: QLatin1String("," ), start: 1,end: 1).toDouble()); |
204 | |
205 | newReadingAvailable(); |
206 | } |
207 | |
208 | char const * const mocktapsensor::id("mock.tap" ); |
209 | |
210 | mocktapsensor::mocktapsensor(QSensor *sensor) |
211 | : mockcommon(sensor) |
212 | { |
213 | setReading<QTapReading>(&m_reading); |
214 | addDataRate(min: 50, max: 50); // 50Hz |
215 | connect(sender: mockcommonPrv(),SIGNAL(tapData(QString)),receiver: this,SLOT(parseTapData(QString))); |
216 | } |
217 | |
218 | void mocktapsensor::parseTapData(const QString &data) |
219 | { |
220 | m_reading.setTimestamp(data.section(in_sep: QLatin1String("," ), start: 0,end: 0).toULongLong()); |
221 | m_reading.setDoubleTap((data.section(in_sep: QLatin1String("," ), start: 1,end: 1).toInt() == 1)); |
222 | |
223 | newReadingAvailable(); |
224 | } |
225 | |
226 | char const * const mockproximitysensor::id("mock.proximity" ); |
227 | |
228 | mockproximitysensor::mockproximitysensor(QSensor *sensor) |
229 | : mockcommon(sensor) |
230 | { |
231 | setReading<QProximityReading>(&m_reading); |
232 | addDataRate(min: 50, max: 50); // 50Hz |
233 | connect(sender: mockcommonPrv(),SIGNAL(proxyData(QString)),receiver: this,SLOT(parseProxyData(QString))); |
234 | } |
235 | |
236 | void mockproximitysensor::parseProxyData(const QString &data) |
237 | { |
238 | m_reading.setTimestamp(data.section(in_sep: QLatin1String("," ), start: 0,end: 0).toULongLong()); |
239 | m_reading.setClose((data.section(in_sep: QLatin1String("," ), start: 1,end: 1).toInt() == 1)); |
240 | |
241 | newReadingAvailable(); |
242 | } |
243 | |