Add function to get angles between two vectors (Vector3.GetAnglesBetweenVectorsForDirectionChange)

.vscode/settings.json

@@ -15,5 +15,10 @@
     },
     "[typescript]": {
         "editor.defaultFormatter": "esbenp.prettier-vscode"
-    },
-}
+	},
+	"prettier.tabWidth": 4,
+	"prettier.printWidth": 180,
+	"prettier.useTabs": false,
+	"prettier.singleQuote": false,
+	"files.insertFinalNewline": false,
+}

packages/dev/core/src/Maths/math.vector.ts

@@ -1716,6 +1716,35 @@ export class Vector3 {
         return Scalar.NormalizeRadians(angle);
     }
 
+    /**
+     * Gets the angles between two vectors needed to change direction
+     * @param start the starting vector
+     * @param target the target vector
+     * @param ref the vector to store the result
+     * @returns the updated ref with the between the two vectors in the form (pitch, yaw, roll)
+     */
+    public static GetAnglesBetweenVectorsForDirectionChangeToRef(start: Vector3, target: Vector3, ref: Vector3): Vector3 {
+        const diff = TmpVectors.Vector3[0];
+        target.subtractToRef(start, diff);
+        ref.y = Math.atan2(diff.x, diff.z) || 0;
+        ref.x = Math.atan2(Math.sqrt(diff.x ** 2 + diff.z ** 2), diff.y) || 0;
+        return ref;
+    }
+
+    /**
+     * Gets the angles between two vectors needed to change direction
+     * @param start the starting vector
+     * @param target the target vector
+     * @returns the angles between the two vectors in the form (pitch, yaw, roll)
+     */
+    public static GetAnglesBetweenVectorsForDirectionChange(start: Vector3, target: Vector3): Vector3 {
+        const diff = TmpVectors.Vector3[0];
+        target.subtractToRef(start, diff);
+        const theta = Math.atan2(diff.x, diff.z) || 0,
+            phi = Math.atan2(Math.sqrt(diff.x ** 2 + diff.z ** 2), diff.y) || 0;
+        return new Vector3(phi, theta, 0);
+    }
+
     /**
      * Slerp between two vectors. See also `SmoothToRef`
      * Slerp is a spherical linear interpolation