summaryrefslogtreecommitdiffhomepage
path: root/tracker-rift-140/rift-140.cpp
diff options
context:
space:
mode:
Diffstat (limited to 'tracker-rift-140/rift-140.cpp')
-rw-r--r--tracker-rift-140/rift-140.cpp111
1 files changed, 111 insertions, 0 deletions
diff --git a/tracker-rift-140/rift-140.cpp b/tracker-rift-140/rift-140.cpp
new file mode 100644
index 00000000..45bfcc97
--- /dev/null
+++ b/tracker-rift-140/rift-140.cpp
@@ -0,0 +1,111 @@
+/* Copyright (c) 2013 mm0zct
+ *
+ * Permission to use, copy, modify, and/or distribute this software for any
+ * purpose with or without fee is hereby granted, provided that the above
+ * copyright notice and this permission notice appear in all copies.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
+ * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
+ * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
+ * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
+ * SOFTWARE.
+ */
+
+#include "rift-140.hpp"
+#include "api/plugin-api.hpp"
+#include "compat/util.hpp"
+#include <Extras/OVR_Math.h>
+
+#include <QString>
+
+using namespace OVR;
+
+rift_tracker_140::rift_tracker_140() : old_yaw(0), hmd(nullptr)
+{
+}
+
+rift_tracker_140::~rift_tracker_140()
+{
+ if (hmd)
+ {
+ ovr_Destroy(hmd);
+ ovr_Shutdown();
+ }
+}
+
+void rift_tracker_140::start_tracker(QFrame*)
+{
+ if (OVR_FAILURE(ovr_Initialize(nullptr)))
+ goto error;
+
+ if(OVR_FAILURE(ovr_Create(&hmd, &luid)))
+ goto error;
+
+ return;
+error:
+ hmd = nullptr;
+
+ ovrErrorInfo err;
+ ovr_GetLastErrorInfo(&err);
+
+ QString strerror(err.ErrorString);
+ if (strerror.size() == 0)
+ strerror = QStringLiteral("Unknown reason #%1").arg(err.Result);
+
+ ovr_Shutdown();
+
+ QMessageBox::warning(nullptr,
+ "Error",
+ QCoreApplication::translate("rift_tracker_140", "Unable to start Rift tracker: %1").arg(strerror),
+ QMessageBox::Ok,
+ QMessageBox::NoButton);
+}
+
+void rift_tracker_140::data(double *data)
+{
+ if (hmd)
+ {
+ ovrTrackingState ss = ovr_GetTrackingState(hmd, 0, false);
+ if (ss.StatusFlags & ovrStatus_OrientationTracked)
+ {
+ static constexpr float c_mult = 8;
+ static constexpr float c_div = 1/c_mult;
+
+ Vector3f axis;
+ float angle;
+
+ const Posef pose(ss.HeadPose.ThePose);
+ pose.Rotation.GetAxisAngle(&axis, &angle);
+ angle *= c_div;
+
+ float yaw, pitch, roll;
+ Quatf(axis, angle).GetYawPitchRoll(&yaw, &pitch, &roll);
+
+ yaw *= c_mult;
+ pitch *= c_mult;
+ roll *= c_mult;
+
+ double yaw_ = double(yaw);
+ if (s.useYawSpring)
+ {
+ yaw_ = old_yaw*s.persistence + (yaw_-old_yaw);
+ if(yaw_ > s.deadzone)
+ yaw_ -= s.constant_drift;
+ if(yaw_ < -s.deadzone)
+ yaw_ += s.constant_drift;
+ old_yaw = yaw_;
+ }
+ static constexpr double d2r = 180 / M_PI;
+ data[Yaw] = yaw_ * -d2r;
+ data[Pitch] = double(pitch) * d2r;
+ data[Roll] = double(roll) * d2r;
+ data[TX] = double(pose.Translation.x) * -1e2;
+ data[TY] = double(pose.Translation.y) * 1e2;
+ data[TZ] = double(pose.Translation.z) * 1e2;
+ }
+ }
+}
+
+OPENTRACK_DECLARE_TRACKER(rift_tracker_140, dialog_rift_140, rift_140Dll)