godotVmcSharp/VmcMessages/VmcExtBonePos.cs

60 lines
2.4 KiB
C#
Raw Normal View History

2023-08-16 19:47:14 +02:00
/*
godotVmcSharp
Copyright (C) 2023 Cassandra de la Cruz-Munoz
This program is free software: you can redistribute it and/or modify
it under the terms of the GNU Affero General Public License as published
by the Free Software Foundation, either version 3 of the License, or
(at your option) any later version.
This program is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
GNU Affero General Public License for more details.
You should have received a copy of the GNU Affero General Public License
along with this program. If not, see <https://www.gnu.org/licenses/>.
*/
using Godot;
using godotOscSharp;
namespace godotVmcSharp
{
public class VmcExtBonePos : VmcMessage
{
2023-09-24 19:06:26 +02:00
public readonly string Name;
public readonly Transform3D Transform;
2023-08-16 19:47:14 +02:00
public static VmcExtBonePos CreateFromMessage(OscMessage m)
2023-08-16 19:47:14 +02:00
{
if (m.Data.Count < 8)
2023-08-16 19:47:14 +02:00
{
throw new MissingArgumentsException(m.Address, "8", m.Data.Count);
2023-08-16 19:47:14 +02:00
}
return new VmcExtBonePos((string)m.Data[0].GetAsString(), new Transform3D(new Basis(new Quaternion(m.Data[4].GetAsFloat(), m.Data[5].GetAsFloat(), m.Data[6].GetAsFloat(), m.Data[7].GetAsFloat())), new Vector3(m.Data[1].GetAsFloat(), m.Data[2].GetAsFloat(), m.Data[3].GetAsFloat())));
2023-08-16 19:47:14 +02:00
}
public VmcExtBonePos(string name, Transform3D transform) : base(new OscAddress("/VMC/Ext/Bone/Pos"))
{
Name = name;
Transform = transform;
}
2023-08-17 01:17:22 +02:00
public new OscMessage ToMessage()
2023-08-17 01:17:22 +02:00
{
var quat = Transform.Basis.GetRotationQuaternion();
2023-08-18 00:22:27 +02:00
return new OscMessage(Addr, new System.Collections.Generic.List<OscArgument>{
OscArgument.CreateFromParams(Name, 's')!,
OscArgument.CreateFromParams(Transform.Origin.X, 'f')!,
OscArgument.CreateFromParams(Transform.Origin.Y, 'f')!,
OscArgument.CreateFromParams(Transform.Origin.Z, 'f')!,
OscArgument.CreateFromParams(quat.X, 'f')!,
OscArgument.CreateFromParams(quat.Y, 'f')!,
OscArgument.CreateFromParams(quat.Z, 'f')!,
OscArgument.CreateFromParams(quat.W, 'f')!,
2023-08-17 01:17:22 +02:00
});
}
2023-08-16 19:47:14 +02:00
}
}