From 159bdaec8ea8da678a456a827cdad737368f8d5f Mon Sep 17 00:00:00 2001
From: Pascal Serrarens <pascal@passervr.com>
Date: Wed, 13 Mar 2024 17:46:41 +0100
Subject: [PATCH] Added spherical.tovector (but is is buggy)

---
 Spherical.cpp | 8 ++++++++
 Spherical.h   | 1 +
 2 files changed, 9 insertions(+)

diff --git a/Spherical.cpp b/Spherical.cpp
index 026d33b..4b230e4 100644
--- a/Spherical.cpp
+++ b/Spherical.cpp
@@ -1,6 +1,7 @@
 #include "Spherical.h"
 
 #include "Angle.h"
+#include "Quaternion.h"
 
 #include <math.h>
 
@@ -47,4 +48,11 @@ float Spherical::GetSwing() {
 
 Polar Spherical::ProjectOnHorizontalPlane() {
   return Polar(horizontalAngle, distance);
+}
+
+Vector3 Spherical::ToVector3() {
+  Vector3 v = Quaternion::Euler(
+                  Vector3(-this->verticalAngle, this->horizontalAngle, 0)) *
+              Vector3::forward * this->distance;
+  return v;
 }
\ No newline at end of file
diff --git a/Spherical.h b/Spherical.h
index 7c98263..8231507 100644
--- a/Spherical.h
+++ b/Spherical.h
@@ -56,6 +56,7 @@ public:
   float GetSwing();
 
   Polar ProjectOnHorizontalPlane();
+  Vector3 ToVector3();
 };
 
 } // namespace Passer