/
Packet85Layer.go
269 lines (241 loc) · 6.78 KB
/
Packet85Layer.go
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
package peer
import (
"fmt"
"github.com/Gskartwii/roblox-dissector/datamodel"
"github.com/robloxapi/rbxfile"
)
// Packet85LayerSubpacket represents physics replication for one instance
type Packet85LayerSubpacket struct {
Data PhysicsData
// See http://wiki.roblox.com/index.php?title=API:Enum/HumanoidStateType
NetworkHumanoidState uint8
// CFrames for any motors attached
// Any other parts attached to this mechanism
Children []*PhysicsData
History []*PhysicsData
}
// PhysicsData represents generic physics data
type PhysicsData struct {
Instance *datamodel.Instance
CFrame rbxfile.ValueCFrame
LinearVelocity rbxfile.ValueVector3
RotationalVelocity rbxfile.ValueVector3
Motors []PhysicsMotor
Interval float32
PlatformChild *datamodel.Instance
}
// Packet85Layer ID_PHYSICS - client <-> server
type Packet85Layer struct {
SubPackets []*Packet85LayerSubpacket
}
// NewPacket85Layer Initializes a new Packet85Layer
func NewPacket85Layer() *Packet85Layer {
return &Packet85Layer{}
}
func (b *extendedReader) readPhysicsData(data *PhysicsData, motors bool, reader PacketReader) error {
var err error
if motors {
data.Motors, err = b.readMotors()
if err != nil {
return err
}
}
data.CFrame, err = b.readPhysicsCFrame()
if err != nil {
return err
}
data.LinearVelocity, err = b.readPhysicsVelocity()
if err != nil {
return err
}
data.RotationalVelocity, err = b.readPhysicsVelocity()
if err != nil {
return err
}
hasPlatformChild, err := b.readBoolByte()
if err != nil || !hasPlatformChild {
return err
}
reference, err := b.ReadObject(reader)
data.PlatformChild, _ = reader.Context().InstancesByReference.TryGetInstance(reference)
return nil
}
func (b *extendedReader) DecodePacket85Layer(reader PacketReader, layers *PacketLayers) (RakNetPacket, error) {
context := reader.Context()
layer := &Packet85Layer{}
for {
reference, err := b.ReadObject(reader)
// unordered packets may have problems with caches
if err != nil && err != ErrCacheReadOOB {
return layer, err
}
if reference.IsNull {
break
}
layers.Root.Logger.Println("reading physics for ref", reference.String())
subpacket := &Packet85LayerSubpacket{}
// ignore errors
subpacket.Data.Instance, _ = context.InstancesByReference.TryGetInstance(reference)
myFlags, err := b.readUint8()
if err != nil {
return layer, err
}
subpacket.NetworkHumanoidState = myFlags & 0x1F
if reader.IsClient() {
err = b.readPhysicsData(&subpacket.Data, true, reader)
if err != nil {
return layer, err
}
} else {
subpacket.Data.Motors, err = b.readMotors()
if err != nil {
return layer, err
}
numEntries, err := b.readUint8()
if err != nil {
return layer, err
}
layers.Root.Logger.Println("reading movement history,", numEntries, "entries")
subpacket.History = make([]*PhysicsData, numEntries)
for i := 0; i < int(numEntries); i++ {
subpacket.History[i] = new(PhysicsData)
subpacket.History[i].Interval, err = b.readFloat32BE()
if err != nil {
return layer, err
}
b.readPhysicsData(subpacket.History[i], false, reader)
if err != nil {
return layer, err
}
}
}
if (myFlags>>5)&1 == 0 { // has children
var object datamodel.Reference
// peerID system shouldn't have caching problems anymore
// TODO: remove cache hack
for object, err = b.ReadObject(reader); (err == nil || err == ErrCacheReadOOB) && !object.IsNull; object, err = b.ReadObject(reader) {
layers.Root.Logger.Println("reading physics child for ref", object.String())
child := new(PhysicsData)
// ignore errors
child.Instance, _ = context.InstancesByReference.TryGetInstance(object)
err = b.readPhysicsData(child, true, reader)
if err != nil {
return layer, err
}
subpacket.Children = append(subpacket.Children, child)
}
if err != nil {
return layer, err
}
}
layer.SubPackets = append(layer.SubPackets, subpacket)
}
return layer, nil
}
func (b *extendedWriter) writePhysicsData(val *PhysicsData, motors bool, writer PacketWriter) error {
var err error
if motors {
err = b.writeMotors(val.Motors)
if err != nil {
return err
}
}
err = b.writePhysicsCFrame(val.CFrame)
if err != nil {
return err
}
err = b.writePhysicsVelocity(val.LinearVelocity)
if err != nil {
return err
}
err = b.writePhysicsVelocity(val.RotationalVelocity)
if err != nil {
return err
}
err = b.writeBoolByte(val.PlatformChild != nil)
if err != nil {
return err
}
err = b.WriteObject(val.PlatformChild, writer)
return err
}
// Serialize implements RakNetPacket.Serialize
func (layer *Packet85Layer) Serialize(writer PacketWriter, stream *extendedWriter) error {
var err error
for i := 0; i < len(layer.SubPackets); i++ {
subpacket := layer.SubPackets[i]
if subpacket.Data.Instance == nil {
println("WARNING: skipping 0x85 serialize because instance doesn't exist yet")
continue
}
err = stream.WriteObject(subpacket.Data.Instance, writer)
if err != nil {
return err
}
var header uint8
header = subpacket.NetworkHumanoidState
if len(subpacket.Children) == 0 { // if bit is OFF, then children are ON -- what kind of logic is this?
header |= 1 << 5
}
err = stream.WriteByte(header)
if err != nil {
return err
}
if !writer.ToClient() { // Writing to server, don't include history
err = stream.writePhysicsData(&subpacket.Data, true, writer)
if err != nil {
return err
}
} else {
err = stream.writeMotors(subpacket.Data.Motors)
if err != nil {
return err
}
err = stream.WriteByte(uint8(len(subpacket.History)))
if err != nil {
return err
}
for i := 0; i < int(len(subpacket.History)); i++ {
err = stream.writeFloat32BE(subpacket.History[i].Interval)
if err != nil {
return err
}
err = stream.writePhysicsData(subpacket.History[i], false, writer)
if err != nil {
return err
}
}
}
for j := 0; j < len(subpacket.Children); j++ {
child := subpacket.Children[j]
if child.Instance == nil {
println("WARNING: 0x85 skipping serialize because child doesn't exist yet!")
continue
}
err = stream.WriteObject(child.Instance, writer)
if err != nil {
return err
}
err = stream.writePhysicsData(child, true, writer)
if err != nil {
return err
}
}
err = stream.WriteObject(nil, writer) // Terminator for children
if err != nil {
return err
}
}
return stream.WriteByte(0x00) // reference to NULL instance; terminator
}
func (layer *Packet85Layer) String() string {
return fmt.Sprintf("ID_PHYSICS: %d items", len(layer.SubPackets))
}
// TypeString implements RakNetPacket.TypeString()
func (Packet85Layer) TypeString() string {
return "ID_PHYSICS"
}
// Type implements RakNetPacket.Type()
func (Packet85Layer) Type() byte {
return 0x85
}