/// <summary>
/// Updates the controller's interaction mappings and ready the current input values.
/// </summary>
/// <param name="inputState"></param>
/// <param name="controllerState"></param>
internal void UpdateController(MlInput.MLInputControllerState inputState, MlController.MLControllerState controllerState)
{
if (!Enabled)
{
return;
}
base.UpdateController();
UpdateControllerData(inputState, controllerState);
if (Interactions == null)
{
Debug.LogError($"No interaction configuration for {GetType().Name} {ControllerHandedness}");
Enabled = false;
}
for (int i = 0; i < Interactions?.Length; i++)
{
var interactionMapping = Interactions[i];
switch (interactionMapping.InputType)
{
case DeviceInputType.SpatialPointer:
Debug.Assert(interactionMapping.AxisType == AxisType.SixDof);
// Update the interaction data source
interactionMapping.PoseData = currentControllerPose;
break;
case DeviceInputType.ButtonPress:
interactionMapping.BoolData = inputState.button_state_bumper;
break;
case DeviceInputType.Menu:
interactionMapping.BoolData = inputState.button_state_home_tap;
break;
case DeviceInputType.Select:
case DeviceInputType.Trigger:
case DeviceInputType.TriggerTouch:
case DeviceInputType.TriggerPress:
case DeviceInputType.TouchpadTouch:
case DeviceInputType.TouchpadPress:
UpdateSingleAxisData(interactionMapping, inputState);
break;
case DeviceInputType.Touchpad:
UpdateDualAxisData(interactionMapping, inputState);
break;
default:
Debug.LogError($"Input [{interactionMapping.InputType}] is not handled for this controller [{GetType().Name}]");
break;
}
interactionMapping.RaiseInputAction(InputSource, ControllerHandedness);
}
}
private void UpdateSingleAxisData(MixedRealityInteractionMapping interactionMapping, MlInput.MLInputControllerState inputState)
{
Debug.Assert(interactionMapping.AxisType == AxisType.SingleAxis || interactionMapping.AxisType == AxisType.Digital);
interactionMapping.FloatData = interactionMapping.Description.Contains("Touchpad")
? inputState.touch_pos_and_force[0].z
: inputState.trigger_normalized;
switch (interactionMapping.InputType)
{
case DeviceInputType.Select:
case DeviceInputType.Trigger:
case DeviceInputType.TriggerPress:
case DeviceInputType.TouchpadPress:
interactionMapping.BoolData = interactionMapping.FloatData.Approximately(1f, 0.001f) ||
interactionMapping.FloatData.Approximately(-1f, 0.001f);
break;
case DeviceInputType.TriggerTouch:
case DeviceInputType.TouchpadTouch:
case DeviceInputType.TriggerNearTouch:
interactionMapping.BoolData = !interactionMapping.FloatData.Equals(0f);
break;
default:
Debug.LogError($"Input [{interactionMapping.InputType}] is not handled for this controller [{GetType().Name}]");
return;
}
}
private void UpdateDualAxisData(MixedRealityInteractionMapping interactionMapping, MlInput.MLInputControllerState inputState)
{
Debug.Assert(interactionMapping.AxisType == AxisType.DualAxis);
if (inputState.touch_pos_and_force[0].z > 0f)
{
dualAxisPosition.x = inputState.touch_pos_and_force[0].x;
dualAxisPosition.y = inputState.touch_pos_and_force[0].y;
}
else
{
dualAxisPosition.x = 0f;
dualAxisPosition.y = 0f;
}
// Update the interaction data source
interactionMapping.Vector2Data = dualAxisPosition;
}
private void UpdateControllerData(MlInput.MLInputControllerState inputState, MlController.MLControllerState controllerState)
{
var lastState = TrackingState;
lastControllerPose = currentControllerPose;
var bestStream = controllerState.stream[0];
for (int i = 0; i < controllerState.stream.Length; i++)
{
if (!controllerState.stream[i].is_active)
{
continue;
}
if (bestStream.mode <= controllerState.stream[i].mode)
{
bestStream = controllerState.stream[i];
}
}
if (!MlPerception.MLPerceptionGetSnapshot(out var snapshot).IsOk)
{
Debug.LogError("Failed to get perception snapshot!");
}
if (bestStream.is_active)
{
if (!MlSnapshot.MLSnapshotGetTransform(snapshot, bestStream.coord_frame_controller, ref controllerTransform).IsOk)
{
Debug.LogError($"Failed to get snapshot transform for controller {controllerState.controller_id}:{bestStream}");
}
}
if (!MlPerception.MLPerceptionReleaseSnapshot(snapshot).IsOk)
{
Debug.LogError("Failed to release perception snapshot!");
}
if (inputState.type == MlInput.MLInputControllerType.Device)
{
// The source is either a hand or a controller that supports pointing.
// We can now check for position and rotation.
IsPositionAvailable = bestStream.mode > MlController.MLControllerMode.Imu3Dof;
if (IsPositionAvailable)
{
IsPositionApproximate = controllerState.accuracy <= MlController.MLControllerCalibAccuracy.Medium;
}
else
{
IsPositionApproximate = false;
}
IsRotationAvailable = bestStream.is_active;
// Devices are considered tracked if we receive position OR rotation data from the sensors.
TrackingState = (IsPositionAvailable || IsRotationAvailable) ? TrackingState.Tracked : TrackingState.NotTracked;
}
else
{
// The input source does not support tracking.
TrackingState = TrackingState.NotApplicable;
}
currentControllerPose.Position = controllerTransform.position;
currentControllerPose.Rotation = controllerTransform.rotation;
// Raise input system events if it is enabled.
if (lastState != TrackingState)
{
InputSystem?.RaiseSourceTrackingStateChanged(InputSource, this, TrackingState);
}
if (TrackingState == TrackingState.Tracked && lastControllerPose != currentControllerPose)
{
if (IsPositionAvailable && IsRotationAvailable)
{
InputSystem?.RaiseSourcePoseChanged(InputSource, this, currentControllerPose);
}
else if (IsPositionAvailable && !IsRotationAvailable)
{
InputSystem?.RaiseSourcePositionChanged(InputSource, this, currentControllerPose.Position);
}
else if (!IsPositionAvailable && IsRotationAvailable)
{
InputSystem?.RaiseSourceRotationChanged(InputSource, this, currentControllerPose.Rotation);
}
}
}
