Implement linearVelocity and angularVelocity of VRPose for OpenVRDevice

device/vr/openvr/openvr_device.cc

 // Copyright (c) 2017 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.
 
 #define _USE_MATH_DEFINES  // for M_PI
 #include "device/vr/openvr/openvr_device.h"
 #include <math.h>
 #include "third_party/openvr/src/headers/openvr.h"
 
 namespace {
 
 constexpr float kRadToDeg = static_cast<float>(180 / M_PI);
 constexpr float kDefaultIPD = 0.06f;  // Default average IPD
 
 device::mojom::VRFieldOfViewPtr openVRFovToWebVRFov(vr::IVRSystem* vr_system,
                                                     vr::Hmd_Eye eye) {
   device::mojom::VRFieldOfViewPtr out = device::mojom::VRFieldOfView::New();
   float up_tan, down_tan, left_tan, right_tan;
   vr_system->GetProjectionRaw(eye, &left_tan, &right_tan, &up_tan, &down_tan);
   out->upDegrees = -(atanf(up_tan) * kRadToDeg);
   out->downDegrees = atanf(down_tan) * kRadToDeg;
   out->leftDegrees = -(atanf(left_tan) * kRadToDeg);
   out->rightDegrees = atanf(right_tan) * kRadToDeg;
   return out;
 }
 
+std::vector<float> HmdVector3ToWebVR(const vr::HmdVector3_t& vec) {
+  std::vector<float> out;
+  out.resize(3);
+  out[0] = vec.v[0];
+  out[1] = vec.v[1];
+  out[2] = vec.v[2];
+  return out;
+}
+
 }  // namespace
 
 namespace device {
 
 OpenVRDevice::OpenVRDevice() {}
 OpenVRDevice::~OpenVRDevice() {}
 
 void OpenVRDevice::CreateVRDisplayInfo(
     const base::Callback<void(mojom::VRDisplayInfoPtr)>& on_created) {
   vr::EVRInitError init_error;
@@ skipping 120 matching lines @@
     const auto& m = transform.m;
     float w = sqrt(1 + m[0][0] + m[1][1] + m[2][2]);
     pose->orientation.value()[0] = (m[2][1] - m[1][2]) / (4 * w);
     pose->orientation.value()[1] = (m[0][2] - m[2][0]) / (4 * w);
     pose->orientation.value()[2] = (m[1][0] - m[0][1]) / (4 * w);
     pose->orientation.value()[3] = w;
 
     pose->position.value()[0] = m[0][3];
     pose->position.value()[1] = m[1][3];
     pose->position.value()[2] = m[2][3];
+
+    pose->linearVelocity = HmdVector3ToWebVR(hmdPose.vVelocity);
+    pose->angularVelocity = HmdVector3ToWebVR(hmdPose.vAngularVelocity);
   }
 
   return std::move(pose);
 }
 
 void OpenVRDevice::OpenVRRenderLoop::GetVSync(
     const mojom::VRVSyncProvider::GetVSyncCallback& callback) {
   static int16_t next_frame = 0;
   int16_t frame = next_frame++;
 
   // TODO(BillOrr): Give real values when VSync loop is hooked up.  This is the
   // presentation time for the frame. Just returning a default value for now
   // since we don't have VSync hooked up.
   base::TimeDelta time = base::TimeDelta::FromSecondsD(2.0);
 
   device::mojom::VRPosePtr pose = getPose();
   Sleep(11);  // TODO (billorr): Use real vsync timing instead of a sleep (this
               // sleep just throttles vsyncs so we don't fill message queues).
   callback.Run(std::move(pose), time, frame,
                device::mojom::VRVSyncProvider::Status::SUCCESS);
 }
 
 }  // namespace device