From 747aeeb6ade94a8e045d8b9bda249ece69ddf3fb Mon Sep 17 00:00:00 2001
From: Cassandra de la Cruz-Munoz <me@cass-dlcm.dev>
Date: Wed, 16 Aug 2023 19:17:22 -0400
Subject: [PATCH] create ToMessage() for VmcExtBonePos

---
 VmcMessages/VmcExtBonePos.cs | 15 +++++++++++++++
 1 file changed, 15 insertions(+)

diff --git a/VmcMessages/VmcExtBonePos.cs b/VmcMessages/VmcExtBonePos.cs
index 0f0103f..c855699 100644
--- a/VmcMessages/VmcExtBonePos.cs
+++ b/VmcMessages/VmcExtBonePos.cs
@@ -83,5 +83,20 @@ namespace godotVmcSharp
             name = _name;
             transform = _transform;
         }
+
+        public godotOscSharp.OscMessage ToMessage()
+        {
+            var quat = transform.Basis.GetRotationQuaternion();
+            return new godotOscSharp.OscMessage(addr, new List<godotOscSharp.OscArgument>{
+                new godotOscSharp.OscArgument(name, 's'),
+                new godotOscSharp.OscArgument(transform.Origin.X, 'f'),
+                new godotOscSharp.OscArgument(transform.Origin.Y, 'f'),
+                new godotOscSharp.OscArgument(transform.Origin.Z, 'f'),
+                new godotOscSharp.OscArgument(quat.X, 'f'),
+                new godotOscSharp.OscArgument(quat.Y, 'f'),
+                new godotOscSharp.OscArgument(quat.Z, 'f'),
+                new godotOscSharp.OscArgument(quat.W, 'f'),
+            });
+        }
     }
 }
\ No newline at end of file