diff options
Diffstat (limited to 'src/plugins/sensors/winrt/winrtgyroscope.cpp')
| -rw-r--r-- | src/plugins/sensors/winrt/winrtgyroscope.cpp | 201 |
1 files changed, 201 insertions, 0 deletions
diff --git a/src/plugins/sensors/winrt/winrtgyroscope.cpp b/src/plugins/sensors/winrt/winrtgyroscope.cpp new file mode 100644 index 00000000..dec65123 --- /dev/null +++ b/src/plugins/sensors/winrt/winrtgyroscope.cpp @@ -0,0 +1,201 @@ +/**************************************************************************** +** +** Copyright (C) 2014 Digia Plc and/or its subsidiary(-ies). +** Contact: http://www.qt-project.org/legal +** +** This file is part of the QtSensors module of the Qt Toolkit. +** +** $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 "winrtgyroscope.h" +#include "winrtcommon.h" + +#include <QtSensors/QGyroscope> + +#include <wrl.h> +#include <windows.devices.sensors.h> +using namespace Microsoft::WRL; +using namespace Microsoft::WRL::Wrappers; +using namespace ABI::Windows::Foundation; +using namespace ABI::Windows::Devices::Sensors; + +typedef ITypedEventHandler<Gyrometer *, GyrometerReadingChangedEventArgs *> InclinometerReadingHandler; + +QT_USE_NAMESPACE + +class WinRtGyroscopePrivate +{ +public: + WinRtGyroscopePrivate(WinRtGyroscope *p) + : minimumReportInterval(0), q(p) + { + token.value = 0; + } + + QGyroscopeReading reading; + + ComPtr<IGyrometer> sensor; + EventRegistrationToken token; + quint32 minimumReportInterval; + + HRESULT readingChanged(IGyrometer *, IGyrometerReadingChangedEventArgs *args) + { + ComPtr<IGyrometerReading> value; + HRESULT hr = args->get_Reading(&value); + if (FAILED(hr)) { + qCWarning(lcWinRtSensors) << "Failed to get gyroscope reading" << qt_error_string(hr); + return hr; + } + + DOUBLE x; + hr = value->get_AngularVelocityX(&x); + if (FAILED(hr)) + qCWarning(lcWinRtSensors) << "Failed to get gyroscope X" << qt_error_string(hr); + + DOUBLE y; + hr = value->get_AngularVelocityY(&y); + if (FAILED(hr)) + qCWarning(lcWinRtSensors) << "Failed to get gyroscope Y" << qt_error_string(hr); + + DOUBLE z; + hr = value->get_AngularVelocityZ(&z); + if (FAILED(hr)) + qCWarning(lcWinRtSensors) << "Failed to get gyroscope Z" << qt_error_string(hr); + + DateTime dateTime; + hr = value->get_Timestamp(&dateTime); + if (FAILED(hr)) + qCWarning(lcWinRtSensors) << "Failed to get gyroscope timestamp" << qt_error_string(hr); + + reading.setX(x); + reading.setY(y); + reading.setZ(z); + reading.setTimestamp(dateTimeToMsSinceEpoch(dateTime)); + q->newReadingAvailable(); + + return S_OK; + } + +private: + WinRtGyroscope *q; +}; + +WinRtGyroscope::WinRtGyroscope(QSensor *sensor) + : QSensorBackend(sensor), d_ptr(new WinRtGyroscopePrivate(this)) +{ + Q_D(WinRtGyroscope); + HStringReference classId(RuntimeClass_Windows_Devices_Sensors_Gyrometer); + ComPtr<IGyrometerStatics> factory; + HRESULT hr = RoGetActivationFactory(classId.Get(), IID_PPV_ARGS(&factory)); + if (FAILED(hr)) { + qCWarning(lcWinRtSensors) << "Unable to initialize gyroscope sensor factory." + << qt_error_string(hr); + sensorError(hr); + return; + } + + hr = factory->GetDefault(&d->sensor); + if (FAILED(hr)) { + qCWarning(lcWinRtSensors) << "Unable to get default gyroscope sensor." + << qt_error_string(hr); + sensorError(hr); + return; + } + + hr = d->sensor->get_MinimumReportInterval(&d->minimumReportInterval); + if (FAILED(hr)) { + qCWarning(lcWinRtSensors) << "Unable to get the minimum report interval." + << qt_error_string(hr); + sensorError(hr); + return; + } + + setReading<QGyroscopeReading>(&d->reading); +} + +WinRtGyroscope::~WinRtGyroscope() +{ +} + +void WinRtGyroscope::start() +{ + Q_D(WinRtGyroscope); + if (!d->sensor) + return; + if (d->token.value) + return; + + ComPtr<InclinometerReadingHandler> callback = + Callback<InclinometerReadingHandler>(d, &WinRtGyroscopePrivate::readingChanged); + HRESULT hr = d->sensor->add_ReadingChanged(callback.Get(), &d->token); + if (FAILED(hr)) { + qCWarning(lcWinRtSensors) << "Unable to attach to reading changed event." + << qt_error_string(hr); + sensorError(hr); + return; + } + quint32 reportInterval = qMax(d->minimumReportInterval, quint32(1000/sensor()->dataRate())); + hr = d->sensor->put_ReportInterval(reportInterval); + if (FAILED(hr)) { + qCWarning(lcWinRtSensors) << "Unable to attach to set report interval." + << qt_error_string(hr); + sensorError(hr); + } +} + +void WinRtGyroscope::stop() +{ + Q_D(WinRtGyroscope); + if (!d->sensor) + return; + if (!d->token.value) + return; + + HRESULT hr = d->sensor->remove_ReadingChanged(d->token); + if (FAILED(hr)) { + qCWarning(lcWinRtSensors) << "Unable to detach from reading changed event." + << qt_error_string(hr); + sensorError(hr); + return; + } + d->sensor->put_ReportInterval(0); + if (FAILED(hr)) { + qCWarning(lcWinRtSensors) << "Unable to reset report interval." + << qt_error_string(hr); + sensorError(hr); + return; + } + d->token.value = 0; +} |