EyeTrackVR/EyeTrackApp/utils/smart_inversion.py
2025-02-12 17:14:50 +13:00

203 lines
7.8 KiB
Python

from eye import EyeId
from enum import Enum
from config import EyeTrackConfig
from utils.CycleCounter import *
import threading
class SmartInversion:
#Defines our possible tracking states
class States(Enum):
TRACKING = 0
STARE = 1
INVERTED = 2
state = States.TRACKING
#Defines our tracked values
thread_lock = threading.Lock()
rx_left_x = 0.0
rx_left_y = 0.0
rx_right_x = 0.0
rx_right_y = 0.0
dom_eye_x = 0.0
dom_eye_y = 0.0
inv_x_thresh = 0.3
is_r_dom = True
bypass_stare = False
#Defines variables that require settings
@classmethod
def init_config(cls,config: EyeTrackConfig):
if config.settings.gui_smartinversion_select_right:
cls.dom_eye = EyeId.RIGHT
cls.rec_eye = EyeId.LEFT
cls.is_r_dom = True
else:
cls.dom_eye = EyeId.LEFT
cls.rec_eye = EyeId.RIGHT
cls.is_r_dom = False
cls.inv_x_thresh = config.settings.gui_smartinversion_minthresh
cls.cycle_counts = config.settings.gui_smartinversion_frame_count
cls.inv_clamp = config.settings.gui_smartinversion_rotation_clamp
cls.inv_counter = CycleCounter(cls.cycle_counts)
cls.stare_counter = CycleCounter(cls.cycle_counts)
cls.track_counter = CycleCounter(cls.cycle_counts)
#Receives changes in configuration and applies them accordingly
@classmethod
def config_update(cls,data):
print(f"Smart inversion heard that some settings were changed!")
if "gui_smartinversion_select_right" in data:
cls.dom_eye = EyeId.RIGHT if data["gui_smartinversion_select_right"] else EyeId.LEFT
cls.rec_eye = EyeId.LEFT if data["gui_smartinversion_select_right"] else EyeId.RIGHT
cls.is_r_dom = True if data["gui_smartinversion_select_right"] else False
print(f"Dominant eye changed to {cls.dom_eye.name}")
if "gui_smartinversion_minthresh" in data:
cls.inv_x_thresh = data["gui_smartinversion_minthresh"]
print(f"Smart inversion transition threshold changed to {cls.inv_x_thresh}")
if "gui_smartinversion_frame_count" in data:
cls.cycle_counts = data["gui_smartinversion_frame_count"]
print(f"Smart inversion transition condition required cycle count changed to {cls.cycle_counts}")
if "gui_smartinversion_rotation_clamp" in data:
cls.inv_clamp = data["gui_smartinversion_rotation_clamp"]
print(f"Smart inversion maximum allowed cross-eye changed to {cls.cycle_counts}")
#Main processing function
@classmethod
def process(cls,eye_id,out_x,out_y):
with cls.thread_lock:
cls.process_tracked_positions(eye_id,out_x,out_y)
cls.check_for_stare()
cls.check_for_inversion()
if cls.is_stare_mode():
out_x, out_y = 0, cls.dom_eye_y
elif not cls.is_dominant_eye(eye_id) and cls.is_inverted_mode():
out_x, out_y = -cls.dom_eye_x, cls.dom_eye_y
else:
out_x, out_y = cls.dom_eye_x, cls.dom_eye_y
if cls.is_inverted_mode():
if cls.is_processing_right_eye(eye_id):
out_x = max(out_x,-cls.inv_clamp)
else:
out_x = min(out_x,cls.inv_clamp)
return out_x, out_y
#Main methods that are called during processing
@classmethod
def process_tracked_positions(cls, eye_id, out_x,out_y):
if cls.is_processing_right_eye(eye_id):
cls.rx_right_x = out_x
cls.rx_right_y = out_y
if cls.is_dominant_eye(eye_id):
cls.dom_eye_x = cls.rx_right_x
cls.dom_eye_y = cls.rx_right_y
else:
cls.rx_left_x = out_x
cls.rx_left_y = out_y
if cls.is_dominant_eye(eye_id):
cls.dom_eye_x = cls.rx_left_x
cls.dom_eye_y = cls.rx_left_y
@classmethod
def check_for_stare(cls):
if cls.dom_is_inward() and cls.rec_is_inward():
#Updates the counter for stare activation
if not cls.is_stare_mode() and not cls.stare_counter.complete():
cls.stare_counter.increase()
#Sets the state to stare if count completes
elif not cls.is_stare_mode() and cls.stare_counter.complete() and not cls.bypass_stare:
cls.set_state("STARE")
print(f"State is {cls.state.name}")
cls.stare_counter.reset()
elif cls.is_stare_mode():
cls.stare_counter.increase()
if cls.stare_counter.complete():
if cls.bypass_stare:
cls.bypass_stare = False
#print(f"bypass_stare disabled by check_for_stare")
cls.set_state("TRACKING")
print(f"State set to {cls.state.name} by check_for_stare method.")
cls.stare_counter.reset()
cls.inv_counter.reset()
elif not cls.stare_counter.active():
cls.stare_counter.reset()
@classmethod
def check_for_inversion(cls):
if cls.dom_is_inward() and cls.rec_meets_thresh() and cls.is_stare_mode():
#Updates the counter for activation
if not cls.is_inverted_mode() and not cls.inv_counter.complete():
cls.inv_counter.increase()
#print(f"Inversion activation counter is increasing: {cls.inv_counter.get_count()}")
#Sets the state to inverted if enough cycles have completed
elif not cls.is_inverted_mode() and cls.inv_counter.complete():
cls.set_state("INVERTED")
print(f"State set to {cls.state.name} by check_for_inv method.")
cls.bypass_stare = True
cls.inv_counter.reset()
#Begins the counter for deactivation if conditions are not met
elif cls.is_inverted_mode():
cls.inv_counter.increase()
if cls.inv_counter.complete():
if cls.bypass_stare:
cls.bypass_stare = False
#print(f"bypass_stare disabled by check_for_inv")
#Fast resets the counter if conditions are not met, and inversion isn't active.
elif cls.inv_counter.active():
cls.inv_counter.reset()
print(f"Inversion activation counter was instantly reset as conditions weren't met")
#Helper Methods
@classmethod
def is_tracking_mode(cls):
return cls.state == cls.States.TRACKING
@classmethod
def is_stare_mode(cls):
return cls.state == cls.States.STARE
@classmethod
def is_inverted_mode(cls):
return cls.state == cls.States.INVERTED
@classmethod
def set_state(cls,new_state: str):
cls.state = cls.States[new_state]
@classmethod
def is_dominant_eye(cls,eye_id):
return eye_id == cls.dom_eye
@classmethod
def is_processing_right_eye(cls,eye_id):
return eye_id == EyeId.RIGHT
@classmethod
def dom_is_inward(cls):
return (cls.is_r_dom and cls.rx_right_x < 0) or (not cls.is_r_dom and cls.rx_left_x > 0)
@classmethod
def rec_is_inward(cls):
return (cls.is_r_dom and cls.rx_left_x > 0) or (not cls.is_r_dom and cls.rx_right_x < 0)
@classmethod
def dom_meets_thresh(cls):
return (cls.is_r_dom and cls.rx_right_x < -cls.inv_x_thresh) or (not cls.is_r_dom and cls.rx_left_x > cls.inv_x_thresh)
@classmethod
def rec_meets_thresh(cls):
return (cls.is_r_dom and cls.rx_left_x > cls.inv_x_thresh) or (not cls.is_r_dom and cls.rx_right_x < -cls.inv_x_thresh)
@classmethod
def x_diff(cls):
return abs(cls.rx_left_x - cls.rx_right_x)