[sensors][win] Add support for AbsoluteOrientation sensor

device/generic_sensor/platform_sensor_reader_win.cc

 // Copyright 2016 The Chromium Authors. All rights reserved.
 // Use of this source code is governed by a BSD-style license that can be
 // found in the LICENSE file.
 
 #include "device/generic_sensor/platform_sensor_reader_win.h"
 
 #include <Sensors.h>
 
 #include "base/callback.h"
 #include "base/memory/ptr_util.h"
@@ skipping 146 matching lines @@
         // sign for each axis. Values are converted from Milligaus to
         // Microtesla.
         reading.values[0] = -x * kMicroteslaInMilligauss;
         reading.values[1] = -y * kMicroteslaInMilligauss;
         reading.values[2] = -z * kMicroteslaInMilligauss;
         return S_OK;
       });
   return params;
 }
 
+// AbsoluteOrientation sensor reader initialization parameters.
+std::unique_ptr<ReaderInitParams> CreateAbsoluteOrientationReaderInitParams() {
+  auto params = base::MakeUnique<ReaderInitParams>();
+  params->sensor_type_id = SENSOR_TYPE_AGGREGATED_DEVICE_ORIENTATION;
+  params->reader_func =
+      base::Bind([](ISensorDataReport& report, SensorReading& reading) {
+        PROPVARIANT quat_variant = {};

[Reilly Grant (use Gerrit), 2017/03/21 18:25:06]

This should also be a base::win::ScopedPropVariant to avoid leaking the memory
pointed to by quat_variant.caub.pElems.

[shalamov, 2017/03/23 13:35:29]

Done.

+        HRESULT hr =
+            report.GetSensorValue(SENSOR_DATA_TYPE_QUATERNION, &quat_variant);
+        if (FAILED(hr) || quat_variant.vt != (VT_VECTOR | VT_UI1) ||
+            quat_variant.caub.cElems < 16) {
+          return E_FAIL;
+        }
+
+        float* quat = (float*)quat_variant.caub.pElems;
+
+        // Windows uses coordinate system where Z axis points down from device
+        // screen, therefore, using right hand notation, we have to reverse
+        // sign for each quaternion component.
+        reading.values[0] = -quat[0];  // x*sin(Theta/2)
+        reading.values[1] = -quat[1];  // y*sin(Theta/2)
+        reading.values[2] = -quat[2];  // z*sin(Theta/2)
+        reading.values[3] = quat[3];   // cos(Theta/2)
+        return S_OK;
+      });
+  return params;
+}
+
 // Creates ReaderInitParams params structure. To implement support for new
 // sensor types, new switch case should be added and appropriate fields must
 // be set:
 // sensor_type_id - GUID of the sensor supported by Windows.
 // reader_func    - Functor that is responsible to populate SensorReading from
 //                  ISensorDataReport data.
 std::unique_ptr<ReaderInitParams> CreateReaderInitParamsForSensor(
     mojom::SensorType type) {
   switch (type) {
     case mojom::SensorType::AMBIENT_LIGHT:
       return CreateAmbientLightReaderInitParams();
     case mojom::SensorType::ACCELEROMETER:
       return CreateAccelerometerReaderInitParams();
     case mojom::SensorType::GYROSCOPE:
       return CreateGyroscopeReaderInitParams();
     case mojom::SensorType::MAGNETOMETER:
       return CreateMagnetometerReaderInitParams();
+    case mojom::SensorType::ABSOLUTE_ORIENTATION:
+      return CreateAbsoluteOrientationReaderInitParams();
     default:
       NOTIMPLEMENTED();
       return nullptr;
   }
 }
 
 }  // namespace
 
 // Class that implements ISensorEvents and IUnknown interfaces and used
 // by ISensor interface to dispatch state and data change events.
@@ skipping 236 matching lines @@
 void PlatformSensorReaderWin::SensorError() {
   if (client_)
     client_->OnSensorError();
 }
 
 unsigned long PlatformSensorReaderWin::GetMinimalReportingIntervalMs() const {
   return init_params_->min_reporting_interval_ms;
 }
 
 }  // namespace device