public static void test_basic_generators()
{
TrivialDiscGenerator disc_gen = new TrivialDiscGenerator();
disc_gen.Generate();
WriteGeneratedMesh(disc_gen, "__g3Test_disc.obj");
TrivialRectGenerator rect_gen = new TrivialRectGenerator();
rect_gen.Generate();
WriteGeneratedMesh(rect_gen, "__g3Test_rect.obj");
PuncturedDiscGenerator punc_disc_gen = new PuncturedDiscGenerator();
punc_disc_gen.Generate();
WriteGeneratedMesh(punc_disc_gen, "__g3Test_punctured_disc.obj");
TrivialBox3Generator box_gen = new TrivialBox3Generator();
Frame3f f = Frame3f.Identity;
f.Rotate(Quaternionf.AxisAngleD(Vector3f.AxisY, 45.0f));
f.Rotate(Quaternionf.AxisAngleD(Vector3f.AxisZ, 45.0f));
box_gen.Box = new Box3d(f.Origin, f.X, f.Y, f.Z, new Vector3d(3, 2, 1));
//box_gen.NoSharedVertices = true;
box_gen.Generate();
WriteGeneratedMesh(box_gen, "__g3Test_trivial_box.obj");
RoundRectGenerator roundrect_gen = new RoundRectGenerator();
roundrect_gen.Width = 2;
roundrect_gen.Generate();
WriteGeneratedMesh(roundrect_gen, "__g3Test_round_rect.obj");
}
public static Frame3f Rotate(Frame3f f, Vector3D origin, Quaternionf rotation)
{
f.Origin -= (Vector3F)origin;
f.Rotate(rotation);
f.Origin += (Vector3F)origin;
return(f);
}
protected override void OnPointUpdated(ControlPoint pt, Frame3f prevFrameS, bool isFirst)
{
Vector3f basePt = GetPointPosition(BasePointID, CoordSpace.SceneCoords).Origin;
Vector3f frontPt = GetPointPosition(FrontPointID, CoordSpace.SceneCoords).Origin;
Vector3f topPt = GetPointPosition(TopPointID, CoordSpace.SceneCoords).Origin;
lastTargetFrameS = TargetSO.GetLocalFrame(CoordSpace.SceneCoords);
Frame3f previewFrameS = lastTargetFrameS;
// position next to original object
previewFrameS = previewFrameS.Translated(1.1f * (float)meshBounds.Width * Vector3f.AxisX);
Vector3f upAxis = (topPt - basePt).Normalized;
// construct a frame perp to upAxis at midpoint, and project original and current fw points
Frame3f upFrame = new Frame3f((topPt + basePt) * 0.5f, upAxis);
Vector3f origFW = upFrame.ProjectToPlane(initialFrontPt, 2);
origFW = (origFW - upFrame.Origin).Normalized;
Vector3f curFW = upFrame.ProjectToPlane(frontPt, 2);
curFW = (curFW - upFrame.Origin).Normalized;
//float angle = MathUtil.PlaneAngleSignedD(origFW, curFW, upAxis);
start_forward_pt_S = upFrame.FromFrameP(origFW);
current_forward_pt_S = upFrame.FromFrameP(curFW);
// construct rotation that aligns up axis with y-up
Quaternionf upRotate = Quaternionf.FromTo(upAxis, Vector3f.AxisY);
previewFrameS.Rotate(upRotate);
// now rotate so that forward dir points along -Z
//Quaternionf fwRotate = Quaternionf.AxisAngleD(Vector3f.AxisY, angle);
//curFW = upRotate * curFW;
Quaternionf fwRotate = Quaternionf.FromToConstrained(curFW, -Vector3f.AxisZ, Vector3f.AxisY);
previewFrameS.Rotate(fwRotate);
previewSO.SetLocalFrame(previewFrameS, CoordSpace.SceneCoords);
lastPreviewFrameS = previewFrameS;
}
public static void test_basic_generators()
{
TrivialDiscGenerator disc_gen = new TrivialDiscGenerator();
WriteGeneratedMesh(disc_gen, "meshgen_Disc.obj");
TrivialRectGenerator rect_gen = new TrivialRectGenerator();
WriteGeneratedMesh(rect_gen, "meshgen_Rect.obj");
GriddedRectGenerator gridrect_gen = new GriddedRectGenerator();
WriteGeneratedMesh(gridrect_gen, "meshgen_GriddedRect.obj");
PuncturedDiscGenerator punc_disc_gen = new PuncturedDiscGenerator();
WriteGeneratedMesh(punc_disc_gen, "meshgen_PuncturedDisc.obj");
TrivialBox3Generator box_gen = new TrivialBox3Generator();
Frame3f f = Frame3f.Identity;
f.Rotate(Quaternionf.AxisAngleD(Vector3f.AxisY, 45.0f));
f.Rotate(Quaternionf.AxisAngleD(Vector3f.AxisZ, 45.0f));
box_gen.Box = new Box3d(f.Origin, f.X, f.Y, f.Z, new Vector3d(3, 2, 1));
WriteGeneratedMesh(box_gen, "meshgen_TrivialBox_shared.obj");
box_gen.NoSharedVertices = true;
WriteGeneratedMesh(box_gen, "meshgen_TrivialBox_noshared.obj");
RoundRectGenerator roundrect_gen = new RoundRectGenerator();
roundrect_gen.Width = 2;
WriteGeneratedMesh(roundrect_gen, "meshgen_RoundRect.obj");
GridBox3Generator gridbox_gen = new GridBox3Generator();
WriteGeneratedMesh(gridbox_gen, "meshgen_GridBox_shared.obj");
gridbox_gen.NoSharedVertices = true;
WriteGeneratedMesh(gridbox_gen, "meshgen_GridBox_noshared.obj");
Sphere3Generator_NormalizedCube normcube_gen = new Sphere3Generator_NormalizedCube();
WriteGeneratedMesh(normcube_gen, "meshgen_Sphere_NormalizedCube_shared.obj");
normcube_gen.NoSharedVertices = true;
normcube_gen.Box = new Box3d(new Frame3f(Vector3f.One, Vector3f.One), Vector3d.One * 1.3);
WriteGeneratedMesh(normcube_gen, "meshgen_Sphere_NormalizedCube_noshared.obj");
TubeGenerator tube_gen = new TubeGenerator()
{
Vertices = new List <Vector3d>()
{
Vector3d.Zero, Vector3d.AxisX, 2 * Vector3d.AxisX, 3 * Vector3d.AxisX
},
Polygon = Polygon2d.MakeCircle(1, 16)
};
WriteGeneratedMesh(tube_gen, "meshgen_TubeGenerator.obj");
tube_gen.Polygon.Translate(Vector2d.One);
tube_gen.CapCenter = Vector2d.One;
WriteGeneratedMesh(tube_gen, "meshgen_TubeGenerator_shifted.obj");
}
public void UpdateTracking(Cockpit cockpit, fCamera camera)
{
fGameObject cockpitGO = cockpit.RootGameObject;
if (!bInitialized)
{
currentFrame = cockpit.GetLevelViewFrame(CoordSpace.WorldCoords);
currentFrame.ConstrainedAlignAxis(2, Vector3f.AxisZ, Vector3f.AxisY);
bInitialized = true;
}
Vector3f vCamFW = camera.Forward();
vCamFW[1] = 0; vCamFW.Normalize(); // I don't think this is strictly necessary but
// better to be safe for now...
Vector3f vCamPos = camera.GetPosition();
//if (tracking_debug == null)
// tracking_debug = UnityUtil.CreatePrimitiveGO("tracking_indicator", PrimitiveType.Sphere, MaterialUtil.CreateStandardMaterial(Color.green), false);
//tracking_debug.transform.position = vCamPos + 15.0f * vCamFW;
//if (tracking_avg == null) {
// tracking_avg = UnityUtil.CreatePrimitiveGO("tracking_indicator", PrimitiveType.Sphere, MaterialUtil.CreateStandardMaterial(Color.blue), false);
// tracking_avg.transform.localScale = new Vector3(0.5f, 0.5f, 0.5f);
//}
//tracking_avg.transform.position = vCamPos + 10.0f * vSlowViewDirTrack;
//tracking_debug.SetVisible(false);
//tracking_avg.SetVisible(false);
if (vSlowViewDirTrack == Vector3f.Zero)
{
vSlowViewDirTrack = vCamFW;
}
float slowTrackSpeed = 0.05f;
vSlowViewDirTrack = VRUtil.AngleLerp(vSlowViewDirTrack, vCamFW, slowTrackSpeed);
// head position tracking
if (IsLocked == false)
{
cockpitGO.SetPosition(vCamPos);
}
//Vector3 vDelta = (camera.transform.position - RootGameObject.transform.position);
//if (vDelta.magnitude > 0.2f)
// RootGameObject.transform.position = camera.transform.position;
////else if ( vDelta.magnitude > 0.05f)
//else
// RootGameObject.transform.position =
// (1.0f - TrackingSpeed) * RootGameObject.transform.position +
// (TrackingSpeed) * camera.transform.position;
float RotationSpeed = 200.0f;
float WarmupTrackingAngleThresh = 55.0f;
float ImmediateTrackingAngleThresh = 65.0f;
float StopTrackingAngleThresh = 5.0f;
float TrackingWarmupDelay = 2.0f;
float TrackingCooldownDelay = 0.75f;
//Vector3 vCockpitFW = cockpitGO.transform.forward;
Vector3f vCockpitFW = currentFrame.Z;
float fSlowHDeviation = VRUtil.PlaneAngle(vCockpitFW, vSlowViewDirTrack);
float fActualViewDeviation = VRUtil.PlaneAngle(vCockpitFW, vCamFW);
bool bDoTrack = false;
if (eState == TrackingState.NotTracking)
{
//tracking_debug.GetComponent<Renderer>().material = MaterialUtil.CreateStandardMaterial(Color.green);
if (fSlowHDeviation > WarmupTrackingAngleThresh)
{
set_tracking_state(TrackingState.TrackingWarmup);
stateChangeStartTime = FPlatform.RealTime();
}
}
else if (eState == TrackingState.TrackingWarmup)
{
//tracking_debug.GetComponent<Renderer>().material = MaterialUtil.CreateStandardMaterial(Color.yellow);
if (fSlowHDeviation > ImmediateTrackingAngleThresh)
{
set_tracking_state(TrackingState.Tracking);
}
else if (fSlowHDeviation > WarmupTrackingAngleThresh)
{
if ((FPlatform.RealTime() - stateChangeStartTime) > TrackingWarmupDelay)
{
set_tracking_state(TrackingState.Tracking);
}
}
else
{
set_tracking_state(TrackingState.NotTracking);
}
}
else if (eState == TrackingState.Tracking)
{
bDoTrack = true;
//tracking_debug.GetComponent<Renderer>().material = MaterialUtil.CreateStandardMaterial(Color.red);
if (fActualViewDeviation < StopTrackingAngleThresh)
{
set_tracking_state(TrackingState.TrackingCooldown);
stateChangeStartTime = FPlatform.RealTime();
}
}
else if (eState == TrackingState.TrackingCooldown)
{
bDoTrack = true;
//tracking_debug.GetComponent<Renderer>().material = MaterialUtil.CreateStandardMaterial(Color.gray);
if (fActualViewDeviation < StopTrackingAngleThresh)
{
if ((FPlatform.RealTime() - stateChangeStartTime) > TrackingCooldownDelay)
{
set_tracking_state(TrackingState.NotTracking);
bDoTrack = false;
}
}
else
{
set_tracking_state(TrackingState.Tracking);
}
}
if (IsLocked)
{
bDoTrack = false;
set_tracking_state(TrackingState.NotTracking);
}
if (bDoTrack)
{
float dt = (float)(FPlatform.RealTime() - animation_last_time);
float fDelta = RotationSpeed * dt;
Vector3f vCurrent = new Vector3f(vCockpitFW[0], 0, vCockpitFW[2]).Normalized;
Vector3f vTarget = new Vector3f(vSlowViewDirTrack[0], 0, vSlowViewDirTrack[2]).Normalized;
//Vector3 vTarget = new Vector3(vCamFW[0], 0, vCamFW[2]).normalized;
Vector3f c = Vector3f.Cross(vCurrent, vTarget);
float a = Vector3f.AngleD(vCurrent, vTarget);
float fSign = (c[1] < 0) ? -1.0f : 1.0f;
float fRotAngle = Math.Min(a, fDelta) * fSign;
currentFrame.Rotate(Quaternionf.AxisAngleD(Vector3f.AxisY, fRotAngle));
}
cockpitGO.SetRotation(currentFrame.Rotation);
animation_last_time = FPlatform.RealTime();
if (indicator == null)
{
indicator = new CockpitTrackingWidget();
indicator.Create(this, cockpit);
cockpit.AddUIElement(indicator, false);
}
indicator.EnableIndicator = show_indicator;
}
