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:LGPL$ |
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 Lesser General Public License Usage |
18 | ** Alternatively, this file may be used under the terms of the GNU Lesser |
19 | ** General Public License version 3 as published by the Free Software |
20 | ** Foundation and appearing in the file LICENSE.LGPL3 included in the |
21 | ** packaging of this file. Please review the following information to |
22 | ** ensure the GNU Lesser General Public License version 3 requirements |
23 | ** will be met: https://www.gnu.org/licenses/lgpl-3.0.html. |
24 | ** |
25 | ** GNU General Public License Usage |
26 | ** Alternatively, this file may be used under the terms of the GNU |
27 | ** General Public License version 2.0 or (at your option) the GNU General |
28 | ** Public license version 3 or any later version approved by the KDE Free |
29 | ** Qt Foundation. The licenses are as published by the Free Software |
30 | ** Foundation and appearing in the file LICENSE.GPL2 and LICENSE.GPL3 |
31 | ** included in the packaging of this file. Please review the following |
32 | ** information to ensure the GNU General Public License requirements will |
33 | ** be met: https://www.gnu.org/licenses/gpl-2.0.html and |
34 | ** https://www.gnu.org/licenses/gpl-3.0.html. |
35 | ** |
36 | ** $QT_END_LICENSE$ |
37 | ** |
38 | ****************************************************************************/ |
39 | |
40 | #include "genericorientationsensor.h" |
41 | #include <QDebug> |
42 | |
43 | char const * const genericorientationsensor::id("generic.orientation"); |
44 | |
45 | genericorientationsensor::genericorientationsensor(QSensor *sensor) |
46 | : QSensorBackend(sensor) |
47 | { |
48 | accelerometer = new QAccelerometer(this); |
49 | accelerometer->addFilter(filter: this); |
50 | accelerometer->connectToBackend(); |
51 | |
52 | setReading<QOrientationReading>(&m_reading); |
53 | setDataRates(accelerometer); |
54 | } |
55 | |
56 | void genericorientationsensor::start() |
57 | { |
58 | accelerometer->setDataRate(sensor()->dataRate()); |
59 | accelerometer->setAlwaysOn(sensor()->isAlwaysOn()); |
60 | accelerometer->start(); |
61 | if (!accelerometer->isActive()) |
62 | sensorStopped(); |
63 | if (accelerometer->isBusy()) |
64 | sensorBusy(); |
65 | } |
66 | |
67 | void genericorientationsensor::stop() |
68 | { |
69 | accelerometer->stop(); |
70 | } |
71 | |
72 | bool genericorientationsensor::filter(QAccelerometerReading *reading) |
73 | { |
74 | QOrientationReading::Orientation o = m_reading.orientation(); |
75 | |
76 | if (reading->y() > 7.35) |
77 | o = QOrientationReading::TopUp; |
78 | else if (reading->y() < -7.35) |
79 | o = QOrientationReading::TopDown; |
80 | else if (reading->x() > 7.35) |
81 | o = QOrientationReading::RightUp; |
82 | else if (reading->x() < -7.35) |
83 | o = QOrientationReading::LeftUp; |
84 | else if (reading->z() > 7.35) |
85 | o = QOrientationReading::FaceUp; |
86 | else if (reading->z() < -7.35) |
87 | o = QOrientationReading::FaceDown; |
88 | |
89 | if (o != m_reading.orientation() || m_reading.timestamp() == 0) { |
90 | m_reading.setTimestamp(reading->timestamp()); |
91 | m_reading.setOrientation(o); |
92 | newReadingAvailable(); |
93 | } |
94 | |
95 | return false; |
96 | } |
97 | |
98 |