Builtin: Add vector.angle(). Returns the angle between 2 vectors (#7738)

1 files changed, 9 insertions, 0 deletions

diff --git a/builtin/common/vector.lua b/builtin/common/vector.lua
index c3d380ed3..9a53409fa 100644
--- a/builtin/common/vector.lua
+++ b/builtin/common/vector.lua
@@ -70,6 +70,15 @@ function vector.direction(pos1, pos2)
 	})
 end
 
+function vector.angle(a, b)
+	local dotp = a.x * b.x + a.y * b.y + a.z * b.z
+	local cpx = a.y * b.z - a.z * b.y
+	local cpy = a.z * b.x - a.x * b.z
+	local cpz = a.x * b.y - a.y * b.x
+	local crossplen = math.sqrt(cpx ^ 2 + cpy ^ 2 + cpz ^ 2)
+	return math.atan2(crossplen, dotp)
+end
+
 function vector.add(a, b)
 	if type(b) == "table" then
 		return {x = a.x + b.x,