Added spherical.tovector (but is is buggy)

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;
 }

Spherical.h

@@ -56,6 +56,7 @@ public:
   float GetSwing();
 
   Polar ProjectOnHorizontalPlane();
+  Vector3 ToVector3();
 };
 
 } // namespace Passer