diff options
Diffstat (limited to 'builtin/common')
| -rw-r--r-- | builtin/common/vector.lua | 9 |
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, |