Hartmut/gdvrpn
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions

better proxying of data into the receivers

Browse source
This commit is contained in:
Hartmut Seichter 2025-07-03 10:27:08 +02:00
parent 4da8618746
commit b54c78da19
3 changed files with 54 additions and 15 deletions
Download patch file Download diff file Expand all files Collapse all files

45
addons/vrpn/scripts/VRPN.gd
View file

@ -2,7 +2,7 @@ extends Node
class_name VRPN
# tracking associated data
enum TrackingData { POS_QUAT, VELOCITY, ACCELERATION }
enum TrackingDataType { POS_QUAT, VELOCITY, ACCELERATION }
# magic cookie
const magic_cookie_start : String = "vrpn: ver."
@ -176,18 +176,53 @@ static func marshall_body(data : PackedByteArray,message_type : int, sender_id:
var quat = Quaternion(body.get_double(),body.get_double(),body.get_double(),body.get_double()).normalized()
# submit to listener
for r in session.tracker_receivers:
r._on_pos_quat({
r._on_tracker({
"type" : TrackingDataType.POS_QUAT,
"tracker" : session.sensors[sender_id],
"sensor" : sensor_id,
"position" : pos,
"rotation" : quat
})
'vrpn_Tracker Velocity':
pass
# get id
var sensor_id = body.get_32()
var padding = body.get_32() # padding
# position
var vel = Vector3(body.get_double(),body.get_double(),body.get_double())
# VRPN quat layout and Godot Quaternion c'tor identical with x,y,z,w
var vel_rot = Quaternion(body.get_double(),body.get_double(),body.get_double(),body.get_double()).normalized()
# submit to listener
for r in session.tracker_receivers:
r._on_tracker({
"type" : TrackingDataType.VELOCITY,
"tracker" : session.sensors[sender_id],
"sensor" : sensor_id,
"velocity_linear" : vel,
"velocity_rotation" : vel_rot
})
'vrpn_Tracker Acceleration':
# get id
var sensor_id = body.get_32()
var padding = body.get_32() # padding
# position
var acc = Vector3(body.get_double(),body.get_double(),body.get_double())
# VRPN quat layout and Godot Quaternion c'tor identical with x,y,z,w
var acc_rot = Quaternion(body.get_double(),body.get_double(),body.get_double(),body.get_double()).normalized()
var acc_dt = body.get_double() # padding
# submit to listener
for r in session.tracker_receivers:
r._on_tracker({
"type" : TrackingDataType.ACCELERATION,
"tracker" : session.sensors[sender_id],
"sensor" : sensor_id,
"acceleration_linear" : acc,
"acceleration_rotation" : acc_rot,
"acceleration_dt" : acc_dt
})
_:
pass
#print("unhandled message type {0}".format([message_type]))
static func aligned_size(actual_size : int, alignment : int = 8) -> int:
return (actual_size + alignment - 1) & ~(alignment - 1)