From 248b3d09ace2a887283b255194a429c087e7a981 Mon Sep 17 00:00:00 2001
From: Brad Hefta-Gaub <brad@highfidelity.io>
Date: Mon, 21 Dec 2015 10:49:49 -0800
Subject: [PATCH] add absolute rotation based hand reticle movement

---
 .../controllers/reticleHandRotationTest.js    | 103 ++++++++++++++++++
 1 file changed, 103 insertions(+)
 create mode 100644 examples/controllers/reticleHandRotationTest.js

diff --git a/examples/controllers/reticleHandRotationTest.js b/examples/controllers/reticleHandRotationTest.js
new file mode 100644
index 0000000000..d413e531df
--- /dev/null
+++ b/examples/controllers/reticleHandRotationTest.js
@@ -0,0 +1,103 @@
+//
+//  reticleHandRotationTest.js
+//  examples/controllers
+//
+//  Created by Brad Hefta-Gaub on 2015/12/15
+//  Copyright 2015 High Fidelity, Inc.
+//
+//  Distributed under the Apache License, Version 2.0.
+//  See the accompanying file LICENSE or http://www.apache.org/licenses/LICENSE-2.0.html
+//
+
+Math.clamp=function(a,b,c) {
+    return Math.max(b,Math.min(c,a));
+}
+
+var whichHand = Controller.Standard.RightHand;
+var whichTrigger = Controller.Standard.RT;
+
+function length(posA, posB) {
+    var dx = posA.x - posB.x;
+    var dy = posA.y - posB.y;
+    var length = Math.sqrt((dx*dx) + (dy*dy))
+    return length;
+}
+
+var EXPECTED_CHANGE = 50;
+var lastPos = Controller.getReticlePosition();
+function moveReticleAbsolute(x, y) {
+    var globalPos = Controller.getReticlePosition();
+    var dX = x - globalPos.x;
+    var dY = y - globalPos.y;
+
+    // some debugging to see if position is jumping around on us...
+    var distanceSinceLastMove = length(lastPos, globalPos);
+    if (distanceSinceLastMove > EXPECTED_CHANGE) {
+        print("------------------ distanceSinceLastMove:" + distanceSinceLastMove + "----------------------------");
+    }
+
+    if (Math.abs(dX) > EXPECTED_CHANGE) {
+        print("surpressing unexpectedly large change dX:" + dX + "----------------------------");
+    }
+    if (Math.abs(dY) > EXPECTED_CHANGE) {
+        print("surpressing unexpectedly large change dY:" + dY + "----------------------------");
+    }
+
+    globalPos.x = x;
+    globalPos.y = y;
+    Controller.setReticlePosition(globalPos);
+    lastPos = globalPos;
+}
+
+
+var MAPPING_NAME = "com.highfidelity.testing.reticleWithHandRotation";
+var mapping = Controller.newMapping(MAPPING_NAME);
+mapping.from(whichTrigger).peek().constrainToInteger().to(Controller.Actions.ReticleClick);
+mapping.from(whichHand).peek().to(function(pose) {
+
+    // NOTE: hack for now
+    var screenSizeX = 1920;
+    var screenSizeY = 1080;
+
+    var rotated = Vec3.multiplyQbyV(pose.rotation, Vec3.UNIT_NEG_Y); // 
+    var absolutePitch = rotated.y; // from 1 down to -1 up ... but note: if you rotate down "too far" it starts to go up again...
+    var absoluteYaw = rotated.z; // from -1 left to 1 right
+    //print("absolutePitch:" + absolutePitch);
+    //print("absoluteYaw:" + absoluteYaw);
+    //Vec3.print("rotated:", rotated);
+
+    var ROTATION_BOUND = 0.6;
+    var clampYaw = Math.clamp(absoluteYaw, -ROTATION_BOUND, ROTATION_BOUND);
+    var clampPitch = Math.clamp(absolutePitch, -ROTATION_BOUND, ROTATION_BOUND);
+    //var clampYaw = absoluteYaw;
+    //print("clampYaw:" + clampYaw);
+    //print("clampPitch:" + clampPitch);
+
+    // if using entire span...
+    //var xRatio = (absoluteYaw + 1) / 2;
+    //var yRatio = (absolutePitch + 1) / 2;
+
+    // if using only from -0.5 to 0.5
+    var xRatio = (clampYaw + ROTATION_BOUND) / (2 * ROTATION_BOUND);
+    var yRatio = (clampPitch + ROTATION_BOUND) / (2 * ROTATION_BOUND);
+
+    //print("xRatio:" + xRatio);
+    //print("yRatio:" + yRatio);
+
+    //print("ratio x:" + xRatio + " y:" + yRatio);
+
+    var x = screenSizeX * xRatio;
+    var y = screenSizeY * yRatio;
+
+    //print("position x:" + x + " y:" + y);
+    if (!(xRatio == 0.5 && yRatio == 0)) {
+        moveReticleAbsolute(x, y);
+    }
+});
+mapping.enable();
+
+Script.scriptEnding.connect(function(){
+    mapping.disable();
+});
+
+