-
Notifications
You must be signed in to change notification settings - Fork 1k
/
NitroxTransform.cs
99 lines (82 loc) · 3.1 KB
/
NitroxTransform.cs
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
using System;
using System.Numerics;
using System.Runtime.Serialization;
using BinaryPack.Attributes;
using NitroxModel.Helper;
namespace NitroxModel.DataStructures.Unity
{
[DataContract]
[Serializable]
public class NitroxTransform
{
[DataMember(Order = 1)]
public NitroxVector3 LocalPosition;
[DataMember(Order = 2)]
public NitroxQuaternion LocalRotation;
[DataMember(Order = 3)]
public NitroxVector3 LocalScale;
public Matrix4x4 LocalToWorldMatrix
{
get
{
Matrix4x4 cachedMatrix = Matrix4x4Extension.Compose(LocalPosition, LocalRotation, LocalScale);
return Parent != null ? cachedMatrix * Parent.LocalToWorldMatrix : cachedMatrix;
}
}
public NitroxTransform Parent;
[IgnoredMember]
public NitroxVector3 Position
{
get
{
Matrix4x4 matrix = Parent?.LocalToWorldMatrix ?? Matrix4x4.Identity;
return matrix.Transform(LocalPosition);
}
set
{
Matrix4x4 matrix = Parent != null ? Matrix4x4Extension.Compose(value, LocalRotation, LocalScale) * Parent.LocalToWorldMatrix.Invert() : Matrix4x4Extension.Compose(value, LocalRotation, LocalScale);
LocalPosition = (NitroxVector3)matrix.Translation;
}
}
[IgnoredMember]
public NitroxQuaternion Rotation
{
get
{
Matrix4x4 matrix = Parent?.LocalToWorldMatrix ?? Matrix4x4.Identity;
Matrix4x4.Decompose(matrix, out Vector3 _, out Quaternion rotation, out Vector3 _);
return (NitroxQuaternion)rotation * LocalRotation;
}
set
{
Matrix4x4 matrix = Parent != null ? Matrix4x4Extension.Compose(LocalPosition, value, LocalScale) * Parent.LocalToWorldMatrix.Invert() : Matrix4x4Extension.Compose(LocalPosition, value, LocalScale);
Matrix4x4.Decompose(matrix, out Vector3 _, out Quaternion rotation, out Vector3 _);
LocalRotation = (NitroxQuaternion)rotation;
}
}
public void SetParent(NitroxTransform parent, bool worldPositionStays = true)
{
if (!worldPositionStays)
{
Parent = parent;
return;
}
NitroxVector3 position = Position;
NitroxQuaternion rotation = Rotation;
Parent = parent;
Position = position;
Rotation = rotation;
}
public NitroxTransform() { }
public NitroxTransform(NitroxVector3 localPosition, NitroxQuaternion localRotation, NitroxVector3 scale)
{
LocalPosition = localPosition;
LocalRotation = localRotation;
LocalScale = scale;
}
public override string ToString()
{
return $"(Position: {Position}, LocalPosition: {LocalPosition}, Rotation: {Rotation}, LocalRotation: {LocalRotation}, LocalScale: {LocalScale})";
}
}
}