81 lines
2.1 KiB
C#
81 lines
2.1 KiB
C#
namespace Oriels;
|
|
|
|
class Trackballer : dof {
|
|
|
|
// data
|
|
public Btn btnIn, btnOut;
|
|
public Quat ori = Quat.Identity;
|
|
Vec3 oldLocalPad;
|
|
Quat delta = Quat.Identity;
|
|
|
|
public void Init() {}
|
|
|
|
public void Frame() {
|
|
Hand hand = Input.Hand(handed);
|
|
if (hand.tracked.IsActive() && !hand.tracked.IsJustActive()) {
|
|
Vec3 anchor = hand.Get(FingerId.Index, JointId.KnuckleMajor).position;
|
|
anchor = anchor + hand.palm.orientation * Vec3.Forward * 0.045f;
|
|
Matrix mAnchor = Matrix.TR(anchor, hand.palm.orientation);
|
|
Matrix mAnchorInv = mAnchor.Inverse;
|
|
|
|
Vec3 pad = anchor.SnapToLine(
|
|
hand.Get(FingerId.Thumb, JointId.Tip).position,
|
|
hand.Get(FingerId.Thumb, JointId.KnuckleMinor).position,
|
|
true
|
|
);
|
|
Vec3 localPad = mAnchorInv.Transform(pad);
|
|
|
|
Color color = Color.White;
|
|
if (btnIn.held) {
|
|
btnIn.Step(localPad.Length < layer[1]);
|
|
} else {
|
|
btnIn.Step(localPad.Length < layer[0]);
|
|
}
|
|
color = btnIn.held ? new Color(1, 0, 0) : color;
|
|
|
|
if (btnOut.held) {
|
|
btnOut.Step(localPad.Length > layer[1]);
|
|
} else {
|
|
btnOut.Step(localPad.Length > layer[2]);
|
|
}
|
|
color = btnOut.held ? new Color(0, 1, 0) : color;
|
|
|
|
if (btnIn.held) {
|
|
delta = Quat.Identity;
|
|
} else {
|
|
if (localPad.Length < layer[1]) {
|
|
delta = PullRequest.Relative(
|
|
hand.palm.orientation,
|
|
PullRequest.Delta(localPad.Normalized, oldLocalPad.Normalized)
|
|
).Normalized;
|
|
}
|
|
}
|
|
|
|
oldLocalPad = localPad;
|
|
|
|
// Draw
|
|
Mesh.Cube.Draw(Mono.inst.matDev, Matrix.TRS(anchor, ori, 0.04f), color);
|
|
|
|
Mesh.Sphere.Draw(Mono.inst.matDev, Matrix.TRS(pad, hand.palm.orientation, 0.015f), new Color(0, 1, 0));
|
|
}
|
|
|
|
Quat newOri = delta * ori;
|
|
if (new Vec3(newOri.x, newOri.y, newOri.z).LengthSq > 0) {
|
|
ori = newOri;
|
|
}
|
|
|
|
// show that you are about to boolean in and out
|
|
|
|
// trackballer demo
|
|
// fly around a "ship" with the cursor
|
|
// and turn it with the thumb trackballer
|
|
}
|
|
|
|
// design
|
|
public Handed handed = Handed.Left;
|
|
public float[] layer = new float[] { 0.00333f, 0.02f, 0.0666f };
|
|
|
|
|
|
|
|
public float scale = 1;
|
|
}
|