EyeTrackVR/EyeTrackApp/utils/smart_inversion.py

107 lines
5.0 KiB
Python

from eye import EyeId
from utils.misc_utils import clamp
def smart_inversion(self, var, out_x, out_y):
#Checks to see if the class already has frame counts, inversion attributes or smoothing attributes
if not hasattr(self, "smartinversion_inverted_frame_count"):
self.smartinversion_inverted_frame_count = 0
if not hasattr(self, "smartinversion_normal_frame_count"):
self.smartinversion_normal_frame_count = 0
if not hasattr(self, "smartinversion_is_inverted"):
self.smartinversion_is_inverted = False
if not hasattr(self, "smartinversion_smoothing_progress"):
self.smartinversion_smoothing_progress = 0
if not hasattr(self, "smartinversion_smoothed_eye_x"):
self.smartinversion_smoothed_eye_x = 0.0
if not hasattr(self, "smartinversion_stare_ahead"):
self.smartinversion_stare_ahead = False
#Updates eye positions with latest
if self.eye_id == EyeId.LEFT:
var.l_eye_x = out_x
var.left_y = out_y
if self.eye_id == EyeId.RIGHT:
var.r_eye_x = out_x
var.right_y = out_y
#Determines which eye is being tracked based off selection and sets values accordingly
if self.settings.gui_smartinversion_select_right:
tracked_eye_x = var.r_eye_x
tracked_eye_y = var.right_y
recessive_eye = EyeId.LEFT
dominant_eye = EyeId.RIGHT
else:
tracked_eye_x = var.l_eye_x
tracked_eye_y = var.left_y
recessive_eye = EyeId.RIGHT
dominant_eye = EyeId.LEFT
#Checks if eyes are straight, and then sets eye gaze forward until inversion threshold is met
if (0 < var.l_eye_x <= self.settings.gui_smartinversion_minthresh) and (self.settings.gui_smartinversion_minthresh <= var.r_eye_x < 0):
if not self.smartinversion_stare_ahead:
self.smartinversion_smoothing_progress = 1
self.smartinversion_is_inverted = False
tracked_eye_x = 0
self.smartinversion_stare_ahead = True
#Checks if eyes are inverted, and then activates inversion if the conditions have been true for a specified number of frames.
if (var.l_eye_x > self.settings.gui_smartinversion_minthresh and var.r_eye_x < -self.settings.gui_smartinversion_minthresh):
self.smartinversion_inverted_frame_count = min(self.smartinversion_inverted_frame_count + 1, self.settings.gui_smartinversion_frame_count)
if self.smartinversion_inverted_frame_count == self.settings.gui_smartinversion_frame_count:
if not self.smartinversion_is_inverted:
self.smartinversion_smoothing_progress = 1
self.smartinversion_normal_frame_count = 0
self.smartinversion_is_inverted = True
self.smartinversion_stare_ahead = False
tracked_eye_x = 0
print(f"Inversion Activated")
elif self.smartinversion_inverted_frame_count > 0:
self.smartinversion_inverted_frame_count = 0
#Checks if the eyes are no longer inverted, and then clears inversion if the conditions haven't been true for a specified number of frames.
if self.smartinversion_is_inverted and (not (var.l_eye_x > self.settings.gui_smartinversion_minthresh and var.r_eye_x < -self.settings.gui_smartinversion_minthresh)):
self.smartinversion_normal_frame_count = min(self.smartinversion_normal_frame_count + 1, self.settings.gui_smartinversion_frame_count)
if self.smartinversion_normal_frame_count == self.settings.gui_smartinversion_frame_count:
if self.smartinversion_is_inverted:
self.smartinversion_is_inverted = False
self.smartinversion_inverted_frame_count = 0
self.smartinversion_stare_ahead = False
print(f"Inversion Cleared")
elif self.smartinversion_normal_frame_count > 0:
self.smartinversion_normal_frame_count = 0
out_x = tracked_eye_x
out_y = tracked_eye_y
#Logic if smoothing is activated
if self.smartinversion_smoothing_progress > 0:
lerp_factor = 0.2
if self.smartinversion_is_inverted:
if self.eye_id == recessive_eye:
self.smartinversion_smoothed_eye_x += (-tracked_eye_x - self.smartinversion_smoothed_eye_x) * lerp_factor
else:
self.smartinversion_smoothed_eye_x += (tracked_eye_x - self.smartinversion_smoothed_eye_x) * lerp_factor
self.smartinversion_smoothing_progress = max(self.smartinversion_smoothing_progress - self.settings.gui_smartinversion_smoothing_rate, 0)
out_x = self.smartinversion_smoothed_eye_x
#Logic if inversion is active, but smoothing is not active
elif self.smartinversion_is_inverted and self.eye_id == recessive_eye:
out_x = -tracked_eye_x
#Limits the maximum allowed inwards rotation if detected as cross-eyed
if self.smartinversion_is_inverted:
if self.eye_id == EyeId.LEFT:
out_x = min(out_x, self.settings.gui_smartinversion_rotation_clamp)
else:
out_x = max(out_x, -self.settings.gui_smartinversion_rotation_clamp)
return out_x, out_y