demos/mobile/qtbubblelevel/accelerometerfilter.cpp

   1 /****************************************************************************
   2 **
   3 ** Copyright (C) 2015 The Qt Company Ltd.
   4 ** Contact: http://www.qt.io/licensing/
   5 **
   6 ** This file is part of the QtDeclarative module of the Qt Toolkit.
   7 **
   8 ** $QT_BEGIN_LICENSE:BSD$
   9 ** You may use this file under the terms of the BSD license as follows:
  10 **
  11 ** "Redistribution and use in source and binary forms, with or without
  12 ** modification, are permitted provided that the following conditions are
  13 ** met:
  14 **   * Redistributions of source code must retain the above copyright
  15 **     notice, this list of conditions and the following disclaimer.
  16 **   * Redistributions in binary form must reproduce the above copyright
  17 **     notice, this list of conditions and the following disclaimer in
  18 **     the documentation and/or other materials provided with the
  19 **     distribution.
  20 **   * Neither the name of The Qt Company Ltd nor the names of its
  21 **     contributors may be used to endorse or promote products derived
  22 **     from this software without specific prior written permission.
  23 **
  24 **
  25 ** THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  26 ** "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  27 ** LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
  28 ** A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
  29 ** OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  30 ** SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
  31 ** LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  32 ** DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  33 ** THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  34 ** (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
  35 ** OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE."
  36 **
  37 ** $QT_END_LICENSE$
  38 **
  39 ****************************************************************************/
  40
  41 #include <math.h>
  42 #include "accelerometerfilter.h"
  43
  44 #define RADIANS_TO_DEGREES 57.2957795
  45
  46 AccelerometerFilter::AccelerometerFilter()
  47     : x(0), y(0), z(0)
  48 {
  49 }
  50
  51 //! [0]
  52 bool AccelerometerFilter::filter(QAccelerometerReading *reading)
  53 {
  54     qreal rx = reading->x();
  55     qreal ry = reading->y();
  56     qreal rz = reading->z();
  57
  58     qreal divider = sqrt(rx * rx + ry * ry + rz * rz);
  59
  60     // Lowpass factor
  61 #ifdef Q_OS_SYMBIAN
  62     float lowPassFactor = 0.10;
  63 #else
  64     float lowPassFactor = 0.05;
  65 #endif
  66
  67     // Calculate the axis angles in degrees and reduce the noise in sensor
  68     // readings.
  69     x += (acos(rx / divider) * RADIANS_TO_DEGREES - 90 - x) * lowPassFactor;
  70     y += (acos(ry / divider) * RADIANS_TO_DEGREES - 90 - y) * lowPassFactor;
  71     z += (acos(rz / divider) * RADIANS_TO_DEGREES - 90 - z) * lowPassFactor;
  72
  73     // The orientations of the accelerometers are different between
  74     // Symbian and Maemo devices so we use the different axes
  75     // depending on the platform.
  76 #if defined(Q_OS_SYMBIAN)
  77     emit rotationChanged(-y);
  78 #else
  79     emit rotationChanged(x);
  80 #endif
  81
  82     // Don't store the reading in the sensor.
  83     return false;
  84 }
  85 //! [0]