343 lines
12 KiB
Python
343 lines
12 KiB
Python
import os
|
||
import ctypes
|
||
import time
|
||
from psutil import process_iter
|
||
from threading import Thread
|
||
import openvr
|
||
import numpy as np
|
||
from PIL import Image
|
||
try:
|
||
from . import overlay_utils as utils
|
||
except ImportError:
|
||
import overlay_utils as utils
|
||
try:
|
||
from utils import printLog
|
||
except ImportError:
|
||
def printLog(*args):
|
||
print(*args)
|
||
|
||
def mat34Id(array):
|
||
arr = openvr.HmdMatrix34_t()
|
||
for i in range(3):
|
||
for j in range(4):
|
||
arr[i][j] = array[i][j]
|
||
return arr
|
||
|
||
def getBaseMatrix(x_pos, y_pos, z_pos, x_rotation, y_rotation, z_rotation):
|
||
arr = np.zeros((3, 4))
|
||
rot = utils.euler_to_rotation_matrix((x_rotation, y_rotation, z_rotation))
|
||
|
||
for i in range(3):
|
||
for j in range(3):
|
||
arr[i][j] = rot[i][j]
|
||
|
||
arr[0][3] = x_pos * z_pos
|
||
arr[1][3] = y_pos * z_pos
|
||
arr[2][3] = - z_pos
|
||
return arr
|
||
|
||
def getHMDBaseMatrix():
|
||
x_pos = 0.0
|
||
y_pos = -0.4
|
||
z_pos = 1.0
|
||
x_rotation = 0.0
|
||
y_rotation = 0.0
|
||
z_rotation = 0.0
|
||
arr = getBaseMatrix(x_pos, y_pos, z_pos, x_rotation, y_rotation, z_rotation)
|
||
return arr
|
||
|
||
def getLeftHandBaseMatrix():
|
||
x_pos = 0.0
|
||
y_pos = -0.06
|
||
z_pos = -0.14
|
||
x_rotation = -62.0
|
||
y_rotation = 154.0
|
||
z_rotation = 71.0
|
||
arr = getBaseMatrix(x_pos, y_pos, z_pos, x_rotation, y_rotation, z_rotation)
|
||
return arr
|
||
|
||
def getRightHandBaseMatrix():
|
||
x_pos = 0.0
|
||
y_pos = -0.06
|
||
z_pos = -0.14
|
||
x_rotation = -62.0
|
||
y_rotation = -154.0
|
||
z_rotation = -71.0
|
||
arr = getBaseMatrix(x_pos, y_pos, z_pos, x_rotation, y_rotation, z_rotation)
|
||
return arr
|
||
|
||
class Overlay:
|
||
def __init__(self, settings_dict):
|
||
self.system = None
|
||
self.overlay = None
|
||
self.handle = None
|
||
self.initialized = False
|
||
self.loop = True
|
||
self.thread_overlay = None
|
||
|
||
self.settings = {}
|
||
self.lastUpdate = {}
|
||
self.fadeRatio = {}
|
||
for key, value in settings_dict.items():
|
||
self.settings[key] = value
|
||
self.lastUpdate[key] = time.monotonic()
|
||
self.fadeRatio[key] = 1
|
||
|
||
def init(self):
|
||
try:
|
||
self.system = openvr.init(openvr.VRApplication_Background)
|
||
self.overlay = openvr.IVROverlay()
|
||
self.overlay_system = openvr.IVRSystem()
|
||
self.handle = {}
|
||
for i, size in enumerate(self.settings.keys()):
|
||
self.handle[size] = self.overlay.createOverlay(f"VRCT{i}", f"VRCT{i}")
|
||
self.overlay.showOverlay(self.handle[size])
|
||
self.initialized = True
|
||
|
||
for size in self.settings.keys():
|
||
self.updateImage(Image.new("RGBA", (1, 1), (0, 0, 0, 0)), size)
|
||
self.updateColor([1, 1, 1], size)
|
||
self.updateOpacity(self.settings[size]["opacity"], size, True)
|
||
self.updateUiScaling(self.settings[size]["ui_scaling"], size)
|
||
self.updatePosition(
|
||
self.settings[size]["x_pos"],
|
||
self.settings[size]["y_pos"],
|
||
self.settings[size]["z_pos"],
|
||
self.settings[size]["x_rotation"],
|
||
self.settings[size]["y_rotation"],
|
||
self.settings[size]["z_rotation"],
|
||
self.settings[size]["tracker"],
|
||
size
|
||
)
|
||
|
||
except Exception as e:
|
||
printLog("error:Could not initialise OpenVR", e)
|
||
|
||
def updateImage(self, img, size):
|
||
if self.initialized is True:
|
||
width, height = img.size
|
||
img = img.tobytes()
|
||
img = (ctypes.c_char * len(img)).from_buffer_copy(img)
|
||
|
||
try:
|
||
self.overlay.setOverlayRaw(self.handle[size], img, width, height, 4)
|
||
except Exception as e:
|
||
printLog("error:Could not update image", e)
|
||
self.initialized = False
|
||
self.reStartOverlay()
|
||
while self.initialized is False:
|
||
time.sleep(0.1)
|
||
self.overlay.setOverlayRaw(self.handle[size], img, width, height, 4)
|
||
self.updateOpacity(self.settings[size]["opacity"], size, True)
|
||
self.lastUpdate[size] = time.monotonic()
|
||
|
||
def clearImage(self, size):
|
||
if self.initialized is True:
|
||
self.updateImage(Image.new("RGBA", (1, 1), (0, 0, 0, 0)), size)
|
||
|
||
def updateColor(self, col, size):
|
||
"""
|
||
col is a 3-tuple representing (r, g, b)
|
||
"""
|
||
if self.initialized is True:
|
||
r, g, b = col
|
||
self.overlay.setOverlayColor(self.handle[size], r, g, b)
|
||
|
||
def updateOpacity(self, opacity, size, with_fade=True):
|
||
self.settings[size]["opacity"] = opacity
|
||
|
||
if self.initialized is True:
|
||
if with_fade is True:
|
||
if self.fadeRatio[size] > 0:
|
||
self.overlay.setOverlayAlpha(self.handle[size], self.fadeRatio[size] * self.settings[size]["opacity"])
|
||
else:
|
||
self.overlay.setOverlayAlpha(self.handle[size], self.settings[size]["opacity"])
|
||
|
||
def updateUiScaling(self, ui_scaling, size):
|
||
self.settings[size]["ui_scaling"] = ui_scaling
|
||
if self.initialized is True:
|
||
self.overlay.setOverlayWidthInMeters(self.handle[size], self.settings[size]["ui_scaling"])
|
||
|
||
def updatePosition(self, x_pos, y_pos, z_pos, x_rotation, y_rotation, z_rotation, tracker, size):
|
||
"""
|
||
x_pos, y_pos, z_pos are floats representing the position of overlay
|
||
x_rotation, y_rotation, z_rotation are floats representing the rotation of overlay
|
||
tracker is a string representing the tracker to use ("HMD", "LeftHand", "RightHand")
|
||
"""
|
||
|
||
self.settings[size]["x_pos"] = x_pos
|
||
self.settings[size]["y_pos"] = y_pos
|
||
self.settings[size]["z_pos"] = z_pos
|
||
self.settings[size]["x_rotation"] = x_rotation
|
||
self.settings[size]["y_rotation"] = y_rotation
|
||
self.settings[size]["z_rotation"] = z_rotation
|
||
self.settings[size]["tracker"] = tracker
|
||
|
||
match tracker:
|
||
case "HMD":
|
||
base_matrix = getHMDBaseMatrix()
|
||
trackerIndex = openvr.k_unTrackedDeviceIndex_Hmd
|
||
case "LeftHand":
|
||
base_matrix = getLeftHandBaseMatrix()
|
||
trackerIndex = self.overlay_system.getTrackedDeviceIndexForControllerRole(openvr.TrackedControllerRole_LeftHand)
|
||
case "RightHand":
|
||
base_matrix = getRightHandBaseMatrix()
|
||
trackerIndex = self.overlay_system.getTrackedDeviceIndexForControllerRole(openvr.TrackedControllerRole_RightHand)
|
||
case _:
|
||
base_matrix = getHMDBaseMatrix()
|
||
trackerIndex = openvr.k_unTrackedDeviceIndex_Hmd
|
||
|
||
translation = (self.settings[size]["x_pos"], self.settings[size]["y_pos"], - self.settings[size]["z_pos"])
|
||
rotation = (self.settings[size]["x_rotation"], self.settings[size]["y_rotation"], self.settings[size]["z_rotation"])
|
||
transform = utils.transform_matrix(base_matrix, translation, rotation)
|
||
transform = mat34Id(transform)
|
||
|
||
if self.initialized is True:
|
||
self.overlay.setOverlayTransformTrackedDeviceRelative(
|
||
self.handle[size],
|
||
trackerIndex,
|
||
transform
|
||
)
|
||
|
||
def updateDisplayDuration(self, display_duration, size):
|
||
self.settings[size]["display_duration"] = display_duration
|
||
|
||
def updateFadeoutDuration(self, fadeout_duration, size):
|
||
self.settings[size]["fadeout_duration"] = fadeout_duration
|
||
|
||
def checkActive(self):
|
||
try:
|
||
if self.system is not None and self.initialized is True:
|
||
new_event = openvr.VREvent_t()
|
||
while self.system.pollNextEvent(new_event):
|
||
if new_event.eventType == openvr.VREvent_Quit:
|
||
return False
|
||
return True
|
||
except Exception as e:
|
||
printLog("error:Could not check SteamVR running", e)
|
||
return False
|
||
|
||
def evaluateOpacityFade(self, lastUpdate, currentTime, size):
|
||
if (currentTime - lastUpdate) > self.settings[size]["display_duration"]:
|
||
timeThroughInterval = currentTime - lastUpdate - self.settings[size]["display_duration"]
|
||
self.fadeRatio[size] = 1 - timeThroughInterval / self.settings[size]["fadeout_duration"]
|
||
if self.fadeRatio[size] < 0:
|
||
self.fadeRatio[size] = 0
|
||
self.overlay.setOverlayAlpha(self.handle[size], self.fadeRatio[size] * self.settings[size]["opacity"])
|
||
|
||
def update(self, size):
|
||
currTime = time.monotonic()
|
||
if self.settings[size]["fadeout_duration"] != 0:
|
||
self.evaluateOpacityFade(self.lastUpdate[size], currTime, size)
|
||
else:
|
||
self.updateOpacity(self.settings[size]["opacity"], size, True)
|
||
|
||
def mainloop(self):
|
||
self.loop = True
|
||
while self.checkActive() is True and self.loop is True:
|
||
startTime = time.monotonic()
|
||
for size in self.settings.keys():
|
||
self.update(size)
|
||
sleepTime = (1 / 16) - (time.monotonic() - startTime)
|
||
if sleepTime > 0:
|
||
time.sleep(sleepTime)
|
||
|
||
def main(self):
|
||
self.init()
|
||
if self.initialized is True:
|
||
self.mainloop()
|
||
|
||
def startOverlay(self):
|
||
self.thread_overlay = Thread(target=self.main)
|
||
self.thread_overlay.daemon = True
|
||
self.thread_overlay.start()
|
||
|
||
def shutdownOverlay(self):
|
||
if isinstance(self.thread_overlay, Thread):
|
||
self.loop = False
|
||
self.thread_overlay.join()
|
||
self.thread_overlay = None
|
||
if isinstance(self.overlay, openvr.IVROverlay):
|
||
for size in self.settings.keys():
|
||
if isinstance(self.handle[size], int):
|
||
self.overlay.destroyOverlay(self.handle[size])
|
||
self.overlay = None
|
||
if isinstance(self.system, openvr.IVRSystem):
|
||
openvr.shutdown()
|
||
self.system = None
|
||
self.initialized = False
|
||
|
||
def reStartOverlay(self):
|
||
self.shutdownOverlay()
|
||
self.startOverlay()
|
||
|
||
@staticmethod
|
||
def checkSteamvrRunning() -> bool:
|
||
_proc_name = "vrmonitor.exe" if os.name == "nt" else "vrmonitor"
|
||
return _proc_name in (p.name() for p in process_iter())
|
||
|
||
if __name__ == "__main__":
|
||
from overlay_image import OverlayImage
|
||
|
||
small_settings = {
|
||
"x_pos": 0.0,
|
||
"y_pos": 0.0,
|
||
"z_pos": 0.0,
|
||
"x_rotation": 0.0,
|
||
"y_rotation": 0.0,
|
||
"z_rotation": 0.0,
|
||
"display_duration": 5,
|
||
"fadeout_duration": 2,
|
||
"opacity": 1.0,
|
||
"ui_scaling": 0.5,
|
||
"tracker": "HMD",
|
||
}
|
||
|
||
large_settings = {
|
||
"x_pos": 0.0,
|
||
"y_pos": 0.0,
|
||
"z_pos": 0.0,
|
||
"x_rotation": 0.0,
|
||
"y_rotation": 0.0,
|
||
"z_rotation": 0.0,
|
||
"display_duration": 5,
|
||
"fadeout_duration": 0,
|
||
"opacity": 1.0,
|
||
"ui_scaling": 0.5,
|
||
"tracker": "LeftHand",
|
||
}
|
||
|
||
settings_dict = {
|
||
"small": small_settings,
|
||
"large": large_settings
|
||
}
|
||
|
||
overlay_image = OverlayImage()
|
||
overlay = Overlay(settings_dict)
|
||
overlay.startOverlay()
|
||
time.sleep(1)
|
||
|
||
# Example usage
|
||
img = overlay_image.createOverlayImageLargeLog("send", "こんにちは、世界！さようなら", "Japanese", "Hello,World!Goodbye", "Japanese")
|
||
overlay.updateImage(img, "large")
|
||
|
||
img = overlay_image.createOverlayImageSmallLog("こんにちは、世界！さようなら", "Japanese", "Hello,World!Goodbye", "Japanese")
|
||
overlay.updateImage(img, "small")
|
||
time.sleep(10)
|
||
|
||
img = overlay_image.createOverlayImageSmallLog("こんにちは、世界！さようなら2", "Japanese", "Hello,World!Goodbye", "Japanese")
|
||
overlay.updateImage(img, "small")
|
||
time.sleep(10)
|
||
|
||
for i in range(100):
|
||
print(i)
|
||
# Example usage
|
||
img = overlay_image.createOverlayImageSmallLog(f"こんにちは、世界！さようなら_{i}", "Japanese", "Hello,World!Goodbye", "Japanese")
|
||
overlay.updateImage(img, "small")
|
||
time.sleep(10)
|
||
|
||
# img = overlay_image.createOverlayImageSmallLog("こんにちは、世界！さようなら", "Japanese", "Hello,World!Goodbye", "Japanese")
|
||
# overlay.updateImage(img, "small")
|
||
# time.sleep(0.5)
|
||
|
||
overlay.shutdownOverlay() |