From 7f1c2b8a00ede0659746102762aeb1da487eb6f8 Mon Sep 17 00:00:00 2001 From: ANAND Date: Sun, 17 Mar 2019 07:35:03 +0530 Subject: Builtin: Add vector.angle(). Returns the angle between 2 vectors (#7738) --- builtin/common/vector.lua | 9 +++++++++ 1 file changed, 9 insertions(+) (limited to 'builtin/common') 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, -- cgit v1.2.3