From 8bd96b78bdf3598549d9de4256af4df93781c528 Mon Sep 17 00:00:00 2001 From: Alexander Volkov Date: Wed, 30 Sep 2015 16:13:55 +0300 Subject: Add compass support to the iio-sensor-proxy backend Change-Id: Ife5ca9224e4a1ac0b57a25aeb59e2f23e505082b Reviewed-by: Alex Blasche --- .../iio-sensor-proxy/iiosensorproxycompass.cpp | 94 ++++++++++++++++++++++ 1 file changed, 94 insertions(+) create mode 100644 src/plugins/sensors/iio-sensor-proxy/iiosensorproxycompass.cpp (limited to 'src/plugins/sensors/iio-sensor-proxy/iiosensorproxycompass.cpp') diff --git a/src/plugins/sensors/iio-sensor-proxy/iiosensorproxycompass.cpp b/src/plugins/sensors/iio-sensor-proxy/iiosensorproxycompass.cpp new file mode 100644 index 00000000..e530e0db --- /dev/null +++ b/src/plugins/sensors/iio-sensor-proxy/iiosensorproxycompass.cpp @@ -0,0 +1,94 @@ +/**************************************************************************** +** +** Copyright (C) 2015 Alexander Volkov +** Copyright (C) 2015 The Qt Company Ltd. +** Contact: http://www.qt.io/licensing/ +** +** This file is part of the QtSensors module of the Qt Toolkit. +** +** $QT_BEGIN_LICENSE:LGPL21$ +** 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 The Qt Company. For licensing terms +** and conditions see http://www.qt.io/terms-conditions. For further +** information use the contact form at http://www.qt.io/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 or version 3 as published by the Free +** Software Foundation and appearing in the file LICENSE.LGPLv21 and +** LICENSE.LGPLv3 included in the packaging of this file. Please review the +** following information to ensure the GNU Lesser General Public License +** requirements will be met: https://www.gnu.org/licenses/lgpl.html and +** http://www.gnu.org/licenses/old-licenses/lgpl-2.1.html. +** +** As a special exception, The Qt Company gives you certain additional +** rights. These rights are described in The Qt Company LGPL Exception +** version 1.1, included in the file LGPL_EXCEPTION.txt in this package. +** +** $QT_END_LICENSE$ +** +****************************************************************************/ + +#include "iiosensorproxycompass.h" +#include "compass_interface.h" + +#include + +char const * const IIOSensorProxyCompass::id("iio-sensor-proxy.compass"); + +static inline QString dbusPath() { return QStringLiteral("/net/hadess/SensorProxy/Compass"); } + +IIOSensorProxyCompass::IIOSensorProxyCompass(QSensor *sensor) + : IIOSensorProxySensorBase(dbusPath(), NetHadessSensorProxyCompassInterface::staticInterfaceName(), sensor) +{ + setReading(&m_reading); + m_sensorProxyInterface = new NetHadessSensorProxyCompassInterface(serviceName(), dbusPath(), + QDBusConnection::systemBus(), this); +} + +IIOSensorProxyCompass::~IIOSensorProxyCompass() +{ +} + +void IIOSensorProxyCompass::start() +{ + if (isServiceRunning()) { + if (m_sensorProxyInterface->hasCompass()) { + QDBusPendingReply<> reply = m_sensorProxyInterface->ClaimCompass(); + reply.waitForFinished(); + if (!reply.isError()) { + double azimuth = m_sensorProxyInterface->compassHeading(); + updateAzimuth(azimuth); + return; + } + } + } + sensorStopped(); +} + +void IIOSensorProxyCompass::stop() +{ + if (isServiceRunning()) { + QDBusPendingReply<> reply = m_sensorProxyInterface->ReleaseCompass(); + reply.waitForFinished(); + } + sensorStopped(); +} + +void IIOSensorProxyCompass::updateProperties(const QVariantMap &changedProperties) +{ + if (changedProperties.contains("CompassHeading")) { + double azimuth = changedProperties.value("CompassHeading").toDouble(); + updateAzimuth(azimuth); + } +} + +void IIOSensorProxyCompass::updateAzimuth(double azimuth) +{ + m_reading.setAzimuth(azimuth); + m_reading.setTimestamp(produceTimestamp()); + newReadingAvailable(); +} -- cgit v1.2.3