public void Evaluate(int SpreadMax)
{
if (FDeltaIn.IsConnected)
{
FCamDelta.SliceCount = FDeltaIn.SliceCount + 1;
for (int i = 0; i < FDeltaIn.SliceCount; i++)
{
FCamDelta[i] = FDeltaIn[i];
}
FCamDelta[-1] = Delta;
}
else
{
FCamDelta[0] = Delta;
}
Delta.LockCursor = false;
Delta.ResetSignals();
if (Delta.InputMouse != null)
{
if (Init)
{
Init = false;
MouseObserver = new AccumulatingMouseObserver();
KeyboardObserver = new AccumulatingKeyboardObserver();
MouseObserver.SubscribeTo(Delta.InputMouse.MouseNotifications);
KeyboardObserver.SubscribeTo(Delta.InputKeyboard.KeyNotifications);
PrevFrameTime = FHDEHost.FrameTime;
}
var dt = FHDEHost.FrameTime - PrevFrameTime;
var smoothness = FSmooth[0] > 0.00001 ? Math.Min(1.0f / (((float)FSmooth[0] / 6.0f) / (float)dt), 1.0f) : 1;
//var carea = MouseObserver?.LastNotification?.ClientArea ?? new Size(1, 1);
//var aspx = Math.Min(1, (double)carea.Height / (double)carea.Width);
//var aspy = Math.Min(1, (double)carea.Width / (double)carea.Height);
var mousepos = new Vector2D(
MouseObserver.AccumulatedXDelta /* aspx*/,
MouseObserver.AccumulatedYDelta /* aspy*/);
var mousewheel = new Vector2D(
(double)MouseObserver.AccumulatedWheelDelta / 120,
(double)MouseObserver.AccumulatedHorizontalWheelDelta / 120);
try
{
if (Delta.InteractUpstream)
{
if (MouseObserver.MouseClicks[FRotationButton[0]].DoubleClick)
{
Delta.ResetRotation = true;
}
if (MouseObserver.MouseClicks[FTranslationXYButton[0]].DoubleClick)
{
Delta.ResetTranslation = true;
}
if (MouseObserver.MouseClicks[FPivotDistanceButton[0]].DoubleClick)
{
Delta.ResetPivotDistance = true;
}
if (MouseObserver.MouseClicks[FZoomButton[0]].DoubleClick)
{
Delta.ResetFov = true;
}
}
}
catch { }
//FMousePos[0] = new Vector4D(mousepos, mousewheel);
//FMouseButtons[0] = (uint) Delta.InputMouse.PressedButtons;
var translxykey = FTranslationXYKey[0] == Keys.None;
var translzkey = FTranslationZKey[0] == Keys.None;
var forw = false;
var left = false;
var backw = false;
var right = false;
var up = false;
var down = false;
var rotkey = FRotationKey[0] == Keys.None;
var rollkey = FRollKey[0] == Keys.None;
var pdkey = FPivotDistanceKey[0] == Keys.None;
var zoomkey = FZoomKey[0] == Keys.None;
var keyboard = from kp in KeyboardObserver.Keypresses.Values select kp.KeyCode;
foreach (var key in keyboard)
{
translxykey = translxykey || key == FTranslationXYKey[0];
translzkey = translzkey || key == FTranslationZKey[0];
if (FWASDSpeed[0] > 0.0)
{
forw = forw || key == FForwardKey[0];
left = left || key == FStrafeLeftKey[0];
backw = backw || key == FBackwardKey[0];
right = right || key == FStrafeRightKey[0];
up = up || key == FStrafeUpKey[0];
down = down || key == FStrafeDownKey[0];
}
rotkey = rotkey || key == FRotationKey[0];
rollkey = rollkey || key == FRollKey[0];
pdkey = pdkey || key == FPivotDistanceKey[0];
zoomkey = zoomkey || key == FZoomKey[0];
}
if (Delta.InteractUpstream)
{
//// Translation
var transl = new Vector3D(0, 0, 0);
var crot = new Vector3D(0, 0, 0);
var translinf = VMath.Lerp(1.0, Math.Max(Delta.ConnectedCamera.Properties.PivotDistance * 0.25, 0.1), FTranslDistInf[0]);
if (MouseObserver.MouseClicks[FTranslationXYButton[0]].Pressed && translxykey)
{
if (!translzkey || FTranslationZKey[0] == Keys.None)
{
transl.x += mousepos.x;
transl.y -= mousepos.y;
Delta.LockCursor = true;
}
}
if (MouseObserver.MouseClicks[FTranslationZButton[0]].Pressed && translzkey)
{
if (!translxykey || FTranslationXYKey[0] == Keys.None)
{
transl.z += mousepos.y;
Delta.LockCursor = true;
}
}
transl *= FTranslSpeed[0] * translinf;
// WASD Transl
if (forw)
{
transl.z -= FWASDSpeed[0];
}
if (backw)
{
transl.z += FWASDSpeed[0];
}
if (left)
{
transl.x += FWASDSpeed[0];
}
if (right)
{
transl.x -= FWASDSpeed[0];
}
if (up)
{
transl.y -= FWASDSpeed[0];
}
if (down)
{
transl.y += FWASDSpeed[0];
}
Delta.Translation = Filters.Lowpass(Delta.Translation.AsSystemVector(), transl.AsSystemVector(), new Vector3(smoothness)).AsVVector();
//// Rotation
bool rotate = false;
var mouserot = new Vector2D(mousepos * FRotSpeed[0]);
if (FInvY[0])
{
mouserot.y *= -1;
}
if (Delta.ConnectedCamera.Properties.PivotDistance < 0.1)
{
mouserot *= -1;
}
if (MouseObserver.MouseClicks[FRotationButton[0]].Pressed && rotkey || forw || backw || left || right || up || down)
{
if (!rollkey || FRollKey[0] == Keys.None)
{
Delta.LockCursor = true;
// Prepare
mouserot.x = Math.Min(Math.Abs(mouserot.x) * 0.1, 0.499) * Math.Sign(mouserot.x);
mouserot.y = Math.Min(Math.Abs(mouserot.y) * 0.1, 0.499) * Math.Sign(mouserot.y);
// Trackball
var trackbpos = new Vector2D(
Math.Pow(Math.Abs(FTrackballScreenPos[0].x), 2) * Math.Sign(FTrackballScreenPos[0].x),
Math.Pow(Math.Abs(FTrackballScreenPos[0].y), 2) * Math.Sign(FTrackballScreenPos[0].y));
trackbpos *= -0.25;
var trackbtr = VMath.Rotate(trackbpos.y * Math.PI * 2, trackbpos.x * Math.PI * -2, 0);
var trackxv = trackbtr * new Vector3D(-1, 0, 0);
var trackyv = trackbtr * new Vector3D(0, -1, 0);
crot = VMath.QuaternionToEulerYawPitchRoll(
(Quaternion.RotationAxis(trackxv.ToSlimDXVector(), (float)(mouserot.y * Math.PI * -2)) *
Quaternion.RotationAxis(trackyv.ToSlimDXVector(), (float)(mouserot.x * Math.PI * -2))
).ToVector4D());
//crot = new Vector3D(mouserot.y, mouserot.x, 0);
crot *= 10;
rotate = true;
}
}
if (MouseObserver.MouseClicks[FRollButton[0]].Pressed && rollkey)
{
if (!rotkey || FRotationKey[0] == Keys.None)
{
Delta.LockCursor = true;
crot += new Vector3D(0, 0, mouserot.x * Math.PI * 2);
rotate = true;
}
}
if (rotate)
{
Delta.LockCursor = true;
}
Delta.PitchYawRoll = Filters.Lowpass(Delta.PitchYawRoll.AsSystemVector(), crot.AsSystemVector(), new Vector3(smoothness)).AsVVector();
double pivotd = 0;
double zoom = mousewheel.y * FScrollMul[0] * FZoomSpeed[0];
if (zoomkey && (!pdkey || FPivotDistanceKey[0] == Keys.None))
{
zoom -= mousewheel.x * FScrollMul[0] * FZoomSpeed[0];
if (MouseObserver.MouseClicks[FZoomButton[0]].Pressed && zoomkey)
{
Delta.LockCursor = true;
zoom -= mousepos.y * FZoomSpeed[0];
}
}
if (pdkey && (!zoomkey || FZoomKey[0] == Keys.None))
{
pivotd -= mousewheel.x * FScrollMul[0] * FTranslSpeed[0];
if (MouseObserver.MouseClicks[FPivotDistanceButton[0]].Pressed && pdkey)
{
Delta.LockCursor = true;
pivotd -= mousepos.y * FTranslSpeed[0];
}
}
Delta.PivotDistance = Filters.Lowpass((float)Delta.PivotDistance, (float)pivotd, smoothness);
Delta.Fov = Filters.Lowpass((float)Delta.Fov, (float)zoom, smoothness);
}
MouseObserver.ResetAccumulation();
KeyboardObserver.ResetAccumulation();
}
else
{
MouseObserver?.Unsubscribe();
KeyboardObserver?.Unsubscribe();
Init = true;
}
PrevFrameTime = FHDEHost.FrameTime;
}