diff options
Diffstat (limited to 'plugins/sensorgestures/qtsensors/qtwistsensorgesturerecognizer.cpp')
| -rw-r--r-- | plugins/sensorgestures/qtsensors/qtwistsensorgesturerecognizer.cpp | 294 |
1 files changed, 294 insertions, 0 deletions
diff --git a/plugins/sensorgestures/qtsensors/qtwistsensorgesturerecognizer.cpp b/plugins/sensorgestures/qtsensors/qtwistsensorgesturerecognizer.cpp new file mode 100644 index 0000000000..d7edfb2d83 --- /dev/null +++ b/plugins/sensorgestures/qtsensors/qtwistsensorgesturerecognizer.cpp @@ -0,0 +1,294 @@ +/**************************************************************************** +** +** Copyright (C) 2012 Digia Plc and/or its subsidiary(-ies). +** Contact: http://www.qt-project.org/legal +** +** This file is part of the Qt Mobility Components. +** +** $QT_BEGIN_LICENSE:LGPL$ +** Commercial License Usage +** Licensees holding valid commercial Qt licenses may use this file in +** accordance with the commercial license agreement provided with the +** Software or, alternatively, in accordance with the terms contained in +** a written agreement between you and Digia. For licensing terms and +** conditions see http://qt.digia.com/licensing. For further information +** use the contact form at http://qt.digia.com/contact-us. +** +** GNU Lesser General Public License Usage +** Alternatively, this file may be used under the terms of the GNU Lesser +** General Public License version 2.1 as published by the Free Software +** Foundation and appearing in the file LICENSE.LGPL included in the +** packaging of this file. Please review the following information to +** ensure the GNU Lesser General Public License version 2.1 requirements +** will be met: http://www.gnu.org/licenses/old-licenses/lgpl-2.1.html. +** +** In addition, as a special exception, Digia gives you certain additional +** rights. These rights are described in the Digia Qt LGPL Exception +** version 1.1, included in the file LGPL_EXCEPTION.txt in this package. +** +** GNU General Public License Usage +** Alternatively, this file may be used under the terms of the GNU +** General Public License version 3.0 as published by the Free Software +** Foundation and appearing in the file LICENSE.GPL included in the +** packaging of this file. Please review the following information to +** ensure the GNU General Public License version 3.0 requirements will be +** met: http://www.gnu.org/copyleft/gpl.html. +** +** +** $QT_END_LICENSE$ +** +****************************************************************************/ + + +#include "qtwistsensorgesturerecognizer.h" + +#include <QtCore/qmath.h> + +QTM_BEGIN_NAMESPACE + +#define RADIANS_TO_DEGREES 57.2957795 + +QTwistSensorGestureRecognizer::QTwistSensorGestureRecognizer(QObject *parent) + : QSensorGestureRecognizer(parent) + , orientationReading(0) + , active(0) + , detecting(0) + , checking(0) + , increaseCount(0) + , decreaseCount(0) + , lastAngle(0) + , detectedAngle(0) +{ +} + +QTwistSensorGestureRecognizer::~QTwistSensorGestureRecognizer() +{ +} + +void QTwistSensorGestureRecognizer::create() +{ +} + +QString QTwistSensorGestureRecognizer::id() const +{ + return QString("QtSensors.twist"); +} + +bool QTwistSensorGestureRecognizer::start() +{ + if (QtSensorGestureSensorHandler::instance()->startSensor(QtSensorGestureSensorHandler::Accel)) { + if (QtSensorGestureSensorHandler::instance()->startSensor(QtSensorGestureSensorHandler::Orientation)) { + active = true; + connect(QtSensorGestureSensorHandler::instance(),SIGNAL(orientationReadingChanged(QOrientationReading *)), + this,SLOT(orientationReadingChanged(QOrientationReading *))); + + connect(QtSensorGestureSensorHandler::instance(),SIGNAL(accelReadingChanged(QAccelerometerReading *)), + this,SLOT(accelChanged(QAccelerometerReading *))); + } else { + QtSensorGestureSensorHandler::instance()->stopSensor(QtSensorGestureSensorHandler::Accel); + active = false; + } + } else { + + active = false; + } + return active; +} + +bool QTwistSensorGestureRecognizer::stop() +{ + QtSensorGestureSensorHandler::instance()->stopSensor(QtSensorGestureSensorHandler::Accel); + QtSensorGestureSensorHandler::instance()->stopSensor(QtSensorGestureSensorHandler::Orientation); + disconnect(QtSensorGestureSensorHandler::instance(),SIGNAL(orientationReadingChanged(QOrientationReading *)), + this,SLOT(orientationReadingChanged(QOrientationReading *))); + + disconnect(QtSensorGestureSensorHandler::instance(),SIGNAL(accelReadingChanged(QAccelerometerReading *)), + this,SLOT(accelChanged(QAccelerometerReading *))); + + reset(); + orientationList.clear(); + active = false; + return active; +} + +bool QTwistSensorGestureRecognizer::isActive() +{ + return active; +} + +void QTwistSensorGestureRecognizer::orientationReadingChanged(QOrientationReading *reading) +{ + orientationReading = reading; + if (orientationList.count() == 3) + orientationList.removeFirst(); + + orientationList.append(reading->orientation()); + + if (orientationList.count() == 3 + && orientationList.at(2) == QOrientationReading::FaceUp + && (orientationList.at(1) == QOrientationReading::RightUp + || orientationList.at(1) == QOrientationReading::LeftUp)) { + checkTwist(); + } + + checkOrientation(); +} + +bool QTwistSensorGestureRecognizer::checkOrientation() +{ + if (orientationReading->orientation() == QOrientationReading::TopDown + || orientationReading->orientation() == QOrientationReading::FaceDown) { + reset(); + return false; + } + return true; +} + + +void QTwistSensorGestureRecognizer::accelChanged(QAccelerometerReading *reading) +{ + if (orientationReading == 0) + return; + + const qreal x = reading->x(); + const qreal y = reading->y(); + const qreal z = reading->z(); + + if (!detecting && !checking&& dataList.count() > 21) + dataList.removeFirst(); + + qreal angle = qAtan(x / qSqrt(y*y + z*z)) * RADIANS_TO_DEGREES; + + if (qAbs(angle) > 2) { + if (detecting){ + if ((angle > 0 && angle < lastAngle) + || (angle < 0 && angle > lastAngle)) { + decreaseCount++; + } else { + if (decreaseCount > 0) + decreaseCount--; + } + } + + if (!detecting && ((angle > 0 && angle > lastAngle) + || (angle < 0 && angle < lastAngle)) + && ((angle > 0 && lastAngle > 0) + || (angle < 0 && lastAngle < 0))) { + increaseCount++; + } else + if (!detecting && increaseCount > 3 && qAbs(angle) > 30) { + decreaseCount = 0; + detecting = true; + detectedAngle = qAtan(y / qSqrt(x*x + z*z)) * RADIANS_TO_DEGREES; + } + } else { + increaseCount = 0; + increaseCount = 0; + } + + lastAngle = angle; + if (detecting && decreaseCount >= 4 && qAbs(angle) < 25) { + checkTwist(); + } + + twistAccelData data; + data.x = x; + data.y = y; + data.z = z; + + if (qAbs(x) > 1) + dataList.append(data); + + if (qAbs(z) > 15.0) { + reset(); + } + +} + +void QTwistSensorGestureRecognizer::checkTwist() +{ + checking = true; + int lastx = 0; + bool ok = false; + bool spinpoint = false; + + if (detectedAngle < 0) { + reset(); + return; + } + + //// check for orientation changes first + if (orientationList.count() < 2) + return; + + if (orientationList.count() > 2) + if (orientationList.at(0) == orientationList.at(2) + && (orientationList.at(1) == QOrientationReading::LeftUp + || orientationList.at(1) == QOrientationReading::RightUp)) { + ok = true; + if (orientationList.at(1) == QOrientationReading::RightUp) + detectedAngle = 1; + else + detectedAngle = -1; + } + + // now the manual increase/decrease count + if (!ok) { + if (increaseCount < 1 || decreaseCount < 3) + return; + + if (increaseCount > 6 && decreaseCount > 4) { + ok = true; + if (orientationList.at(1) == QOrientationReading::RightUp) + detectedAngle = 1; + else + detectedAngle = -1; + } + } + // now we're really grasping for anything + if (!ok) + for (int i = 0; i < dataList.count(); i++) { + twistAccelData curData = dataList.at(i); + if (!spinpoint && qAbs(curData.x) < 1) + continue; + if (curData.z >= 0 ) { + if (!spinpoint && (curData.x > lastx || curData.x < lastx) && curData.x - lastx > 1) { + ok = true; + } else if (spinpoint && (curData.x < lastx || curData.x > lastx)&& lastx - curData.x > 1) { + ok = true; + } else { + ok = false; + } + } else if (!spinpoint && curData.z < 0) { + spinpoint = true; + } else if (spinpoint && curData.z > 9) { + break; + } + + lastx = curData.x; + } + if (ok) { + if (detectedAngle > 0) { + Q_EMIT twistLeft(); + Q_EMIT detected("twistLeft"); + } else { + Q_EMIT twistRight(); + Q_EMIT detected("twistRight"); + } + } + reset(); +} + +void QTwistSensorGestureRecognizer::reset() +{ + detecting = false; + checking = false; + dataList.clear(); + increaseCount = 0; + decreaseCount = 0; + lastAngle = 0; +} + +#include "moc_qtwistsensorgesturerecognizer.cpp" + +QTM_END_NAMESPACE |