diff --git a/SocketClient.gd b/SocketClient.gd index 40996bf..39fabfa 100644 --- a/SocketClient.gd +++ b/SocketClient.gd @@ -63,60 +63,9 @@ func _on_data(data : Array): # kaboom we just send back the same cookie :) self.send(bytes) else: - # non-cookie - 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) - + VRPN.marshal(bytes) -static func aligned_size(actual_size : int,alignment : int = 8) -> int: - return (actual_size + alignment - 1) & ~(alignment - 1) + func _on_connected(s : StreamPeerTCP):