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

try to parse data

Browse source
This commit is contained in:
Hartmut Seichter 2025-06-27 17:29:32 +02:00
parent d082eb179d
commit 439cb07ccf
1 changed files with 2 additions and 53 deletions
Download patch file Download diff file Expand all files Collapse all files

55
SocketClient.gd
View file

@ -63,60 +63,9 @@ func _on_data(data : Array):
# kaboom we just send back the same cookie :) # kaboom we just send back the same cookie :)
self.send(bytes) self.send(bytes)
else: else:
# non-cookie VRPN.marshal(bytes)
var header := StreamPeerBuffer.new()
header.data_array = bytes.slice(0,aligned_size(20))
header.big_endian = true
# Header
var length = header.get_32() # length of message
var time_sec = header.get_32() # time sec
var time_msec = header.get_32() # time micro sec
var sender_id = header.get_32() # sender id
var message_type = header.get_32() # type of message (payload)
var sequence_num = header.get_32() # inofficial sequence number (padding)
if false:
print("length %d" % length)
print("time_sec %d" % time_sec)
print("time_msec %d" % time_msec)
print("sender_id %d" % sender_id)
print("message_type %d" % message_type)
print("sequence_num %d" % sequence_num)
#print(bytes)
# sender description
if message_type == -1:
var body := StreamPeerBuffer.new()
body.data_array = bytes.slice(24,length-24)
body.big_endian = true
var body_length = body.get_32()
print(body_length)
#var sender_name = peer.get_string(body_length)
#print("sender id {0} is {1}".format([sender_id,sender_name]))
# quat pos
if message_type == 4:
var body := StreamPeerBuffer.new()
body.data_array = bytes.slice(24,length-24)
body.big_endian = true
var sensor_id = body.get_32()
var padding = body.get_32()
var pos = Vector3(body.get_float(),body.get_float(),body.get_float())
var quat_w = body.get_float()
var quat_x = body.get_float()
var quat_y = body.get_float()
var quat_z = body.get_float()
var quat = Quaternion(quat_x,quat_y,quat_z,quat_w)
#print("Pos_Quat ",sensor_id,pos,quat)
static func aligned_size(actual_size : int,alignment : int = 8) -> int:
return (actual_size + alignment - 1) & ~(alignment - 1)
func _on_connected(s : StreamPeerTCP): func _on_connected(s : StreamPeerTCP):