builtin/common/vector.lua

   1
   2 vector = {}
   3
   4 function vector.new(a, b, c)
   5         if type(a) == "table" then
   6                 assert(a.x and a.y and a.z, "Invalid vector passed to vector.new()")
   7                 return {x=a.x, y=a.y, z=a.z}
   8         elseif a then
   9                 assert(b and c, "Invalid arguments for vector.new()")
  10                 return {x=a, y=b, z=c}
  11         end
  12         return {x=0, y=0, z=0}
  13 end
  14
  15 function vector.equals(a, b)
  16         return a.x == b.x and
  17                a.y == b.y and
  18                a.z == b.z
  19 end
  20
  21 function vector.length(v)
  22         return math.hypot(v.x, math.hypot(v.y, v.z))
  23 end
  24
  25 function vector.normalize(v)
  26         local len = vector.length(v)
  27         if len == 0 then
  28                 return {x=0, y=0, z=0}
  29         else
  30                 return vector.divide(v, len)
  31         end
  32 end
  33
  34 function vector.floor(v)
  35         return {
  36                 x = math.floor(v.x),
  37                 y = math.floor(v.y),
  38                 z = math.floor(v.z)
  39         }
  40 end
  41
  42 function vector.round(v)
  43         return {
  44                 x = math.floor(v.x + 0.5),
  45                 y = math.floor(v.y + 0.5),
  46                 z = math.floor(v.z + 0.5)
  47         }
  48 end
  49
  50 function vector.apply(v, func)
  51         return {
  52                 x = func(v.x),
  53                 y = func(v.y),
  54                 z = func(v.z)
  55         }
  56 end
  57
  58 function vector.distance(a, b)
  59         local x = a.x - b.x
  60         local y = a.y - b.y
  61         local z = a.z - b.z
  62         return math.hypot(x, math.hypot(y, z))
  63 end
  64
  65 function vector.direction(pos1, pos2)
  66         return vector.normalize({
  67                 x = pos2.x - pos1.x,
  68                 y = pos2.y - pos1.y,
  69                 z = pos2.z - pos1.z
  70         })
  71 end
  72
  73 function vector.angle(a, b)
  74         local dotp = vector.dot(a, b)
  75         local cp = vector.cross(a, b)
  76         local crossplen = vector.length(cp)
  77         return math.atan2(crossplen, dotp)
  78 end
  79
  80 function vector.dot(a, b)
  81         return a.x * b.x + a.y * b.y + a.z * b.z
  82 end
  83
  84 function vector.cross(a, b)
  85         return {
  86                 x = a.y * b.z - a.z * b.y,
  87                 y = a.z * b.x - a.x * b.z,
  88                 z = a.x * b.y - a.y * b.x
  89         }
  90 end
  91
  92 function vector.add(a, b)
  93         if type(b) == "table" then
  94                 return {x = a.x + b.x,
  95                         y = a.y + b.y,
  96                         z = a.z + b.z}
  97         else
  98                 return {x = a.x + b,
  99                         y = a.y + b,
 100                         z = a.z + b}
 101         end
 102 end
 103
 104 function vector.subtract(a, b)
 105         if type(b) == "table" then
 106                 return {x = a.x - b.x,
 107                         y = a.y - b.y,
 108                         z = a.z - b.z}
 109         else
 110                 return {x = a.x - b,
 111                         y = a.y - b,
 112                         z = a.z - b}
 113         end
 114 end
 115
 116 function vector.multiply(a, b)
 117         if type(b) == "table" then
 118                 return {x = a.x * b.x,
 119                         y = a.y * b.y,
 120                         z = a.z * b.z}
 121         else
 122                 return {x = a.x * b,
 123                         y = a.y * b,
 124                         z = a.z * b}
 125         end
 126 end
 127
 128 function vector.divide(a, b)
 129         if type(b) == "table" then
 130                 return {x = a.x / b.x,
 131                         y = a.y / b.y,
 132                         z = a.z / b.z}
 133         else
 134                 return {x = a.x / b,
 135                         y = a.y / b,
 136                         z = a.z / b}
 137         end
 138 end
 139
 140 function vector.sort(a, b)
 141         return {x = math.min(a.x, b.x), y = math.min(a.y, b.y), z = math.min(a.z, b.z)},
 142                 {x = math.max(a.x, b.x), y = math.max(a.y, b.y), z = math.max(a.z, b.z)}
 143 end