batteries/vec2.lua

--[[
	2d vector type
]]

--[[
	notes:

	depends on a class() function as in oo.lua

	some methods depend on math library extensions

		math.clamp(v, min, max) - return v clamped between min and max
		math.round(v) - round v downwards if fractional part is < 0.5
]]

local vec2 = class()
vec2.x = 0
vec2.y = 0

--probably-too-flexible ctor
function vec2:new(x, y)
	if x and y then
		return vec2:xy(x,y)
	elseif x then
		if type(x) == "number" then
			return vec2:filled(x)
		elseif x.copy then
			return x:copy()
		end
	end
	return vec2:zero()
end

--explicit ctors
function vec2:copy()
	return self:init({
		x = self.x, y = self.y
	})
end

function vec2:xy(x, y)
	return self:init({
		x = x, y = y
	})
end

function vec2:filled(v)
	return self:init({
		x = v, y = v
	})
end

function vec2:zero()
	return vec2:filled(0)
end

--shared pooled storage
local _vec2_pool = {}
--size limit for tuning memory upper bound
local _vec2_pool_limit = 128

function vec2.pool_size()
	return #_vec2_pool
end

--flush the entire pool
function vec2.flush_pool()
	if vec2.pool_size() > 0 then
		_vec2_pool = {}
	end
end

--drain one element from the pool, if it exists
function vec2.drain_pool()
	if #_vec2_pool > 0 then
		return table.remove(_vec2_pool)
	end
	return nil
end

--get a pooled vector (initialise it yourself)
function vec2:pooled()
	return vec2.drain_pool() or vec2:zero()
end

--get a pooled copy of an existing vector
function vec2:pooled_copy()
	return vec2:pooled():vset(self)
end

--release a vector to the pool
function vec2:release()
	if vec2.pool_size() < _vec2_pool_limit then
		table.insert(_vec2_pool, self)
	end
end

--unpack for multi-args

function vec2:unpack()
	return self.x, self.y
end

--pack when a sequence is needed
--(not particularly useful)

function vec2:pack()
	return {self:unpack()}
end

--modify

function vec2:sset(x, y)
	if not y then y = x end
	self.x = x
	self.y = y
	return self
end

function vec2:vset(v)
	self.x = v.x
	self.y = v.y
	return self
end

function vec2:swap(v)
	local sx, sy = self.x, self.y
	self:vset(v)
	v:sset(sx, sy)
	return self
end

-----------------------------------------------------------
--equality comparison
-----------------------------------------------------------

--threshold for equality in each dimension
local EQUALS_EPSILON = 1e-9

--true if a and b are functionally equivalent
function vec2.equals(a, b)
	return (
		math.abs(a.x - b.x) <= EQUALS_EPSILON and
		math.abs(a.y - b.y) <= EQUALS_EPSILON
	)
end

--true if a and b are not functionally equivalent
--(very slightly faster than `not vec2.equals(a, b)`)
function vec2.nequals(a, b)
	return (
		math.abs(a.x - b.x) > EQUALS_EPSILON or
		math.abs(a.y - b.y) > EQUALS_EPSILON
	)
end

-----------------------------------------------------------
--arithmetic
-----------------------------------------------------------

--immediate mode

--vector
function vec2:vaddi(v)
	self.x = self.x + v.x
	self.y = self.y + v.y
	return self
end

function vec2:vsubi(v)
	self.x = self.x - v.x
	self.y = self.y - v.y
	return self
end

function vec2:vmuli(v)
	self.x = self.x * v.x
	self.y = self.y * v.y
	return self
end

function vec2:vdivi(v)
	self.x = self.x / v.x
	self.y = self.y / v.y
	return self
end

--scalar
function vec2:saddi(x, y)
	if y then
		self.x = self.x + x
		self.y = self.y + y
	else
		self.x = self.x + x
		self.y = self.y + x
	end
	return self
end

function vec2:ssubi(x, y)
	if y then
		self.x = self.x - x
		self.y = self.y - y
	else
		self.x = self.x - x
		self.y = self.y - x
	end
	return self
end

function vec2:smuli(x, y)
	if y then
		self.x = self.x * x
		self.y = self.y * y
	else
		self.x = self.x * x
		self.y = self.y * x
	end
	return self
end

function vec2:sdivi(x, y)
	if y then
		self.x = self.x / x
		self.y = self.y / y
	else
		self.x = self.x / x
		self.y = self.y / x
	end
	return self
end

--garbage mode

function vec2:vadd(v)
	return self:copy():vaddi(v)
end

function vec2:vsub(v)
	return self:copy():vsubi(v)
end

function vec2:vmul(v)
	return self:copy():vmuli(v)
end

function vec2:vdiv(v)
	return self:copy():vdivi(v)
end

function vec2:sadd(x, y)
	return self:copy():saddi(x, y)
end

function vec2:ssub(x, y)
	return self:copy():ssubi(x, y)
end

function vec2:smul(x, y)
	return self:copy():smuli(x, y)
end

function vec2:sdiv(x, y)
	return self:copy():sdivi(x, y)
end

--fused multiply-add (a + (b * t))

function vec2:fmai(v, t)
	self.x = self.x + (v.x * t)
	self.y = self.y + (v.y * t)
	return self
end

function vec2:fma(v, t)
	return self:copy():fmai(v, t)
end

-----------------------------------------------------------
-- geometric methods
-----------------------------------------------------------

function vec2:length_squared()
	return self.x * self.x + self.y * self.y
end

function vec2:length()
	return math.sqrt(self:length_squared())
end

function vec2:distance_squared(other)
	local dx = self.x - other.x
	local dy = self.y - other.y
	return dx * dx + dy * dy
end

function vec2:distance(other)
	return math.sqrt(self:distance_squared(other))
end

--immediate mode

function vec2:normalisei_both()
	local len = self:length()
	if len == 0 then
		return self, 0
	end
	return self:sdivi(len), len
end

function vec2:normalisei()
	local v, len = self:normalisei_both()
	return v
end

function vec2:normalisei_len()
	local v, len = self:normalisei_both()
	return len
end

function vec2:inversei()
	return self:smuli(-1)
end

function vec2:rotatei(angle)
	local s = math.sin(angle)
	local c = math.cos(angle)
	local ox = self.x
	local oy = self.y
	self.x = c * ox - s * oy
	self.y = s * ox + c * oy
	return self
end

function vec2:rot90ri()
	local ox = self.x
	local oy = self.y
	self.x = -oy
	self.y = ox
	return self
end

function vec2:rot90li()
	local ox = self.x
	local oy = self.y
	self.x = oy
	self.y = -ox
	return self
end

vec2.rot180i = vec2.inversei --alias

function vec2:rotate_aroundi(angle, pivot)
	local s = math.sin(angle)
	local c = math.cos(angle)
	local ox = self.x - pivot.x
	local oy = self.y - pivot.y
	self.x = (c * ox - s * oy) + pivot.x
	self.y = (s * ox + c * oy) + pivot.y
	return self
end

function vec2:rotate_around(angle, pivot)
	return self:copy():rotate_aroundi(angle, pivot)
end

--garbage mode

function vec2:normalised()
	return self:copy():normalisei()
end

function vec2:normalised_len()
	local v = self:copy()
	local len = v:normalisei_len()
	return v, len
end

function vec2:inverse()
	return self:copy():inversei()
end

function vec2:rotate(angle)
	return self:copy():rotatei(angle)
end

function vec2:rot90r()
	return self:copy():rot90ri()
end

function vec2:rot90l()
	return self:copy():rot90li()
end

vec2.rot180 = vec2.inverse --alias

function vec2:angle()
	return math.atan2(self.y, self.x)
end

-----------------------------------------------------------
-- per-component clamping ops
-----------------------------------------------------------

function vec2:mini(v)
	self.x = math.min(self.x, v.x)
	self.y = math.min(self.y, v.y)
	return self
end

function vec2:maxi(v)
	self.x = math.max(self.x, v.x)
	self.y = math.max(self.y, v.y)
	return self
end

function vec2:clampi(min, max)
	self.x = math.clamp(self.x, min.x, max.x)
	self.y = math.clamp(self.y, min.y, max.y)
	return self
end

function vec2:min(v)
	return self:copy():mini(v)
end

function vec2:max(v)
	return self:copy():maxi(v)
end

function vec2:clamp(min, max)
	return self:copy():clampi(min, max)
end

-----------------------------------------------------------
-- absolute value
-----------------------------------------------------------

function vec2:absi()
	self.x = math.abs(self.x)
	self.y = math.abs(self.y)
	return self
end

function vec2:abs()
	return self:copy():absi()
end

-----------------------------------------------------------
-- truncation/rounding
-----------------------------------------------------------

function vec2:floori()
	self.x = math.floor(self.x)
	self.y = math.floor(self.y)
	return self
end

function vec2:ceili()
	self.x = math.ceil(self.x)
	self.y = math.ceil(self.y)
	return self
end

function vec2:roundi()
	self.x = math.round(self.x)
	self.y = math.round(self.y)
	return self
end

function vec2:floor()
	return self:copy():floori()
end

function vec2:ceil()
	return self:copy():ceili()
end

function vec2:round()
	return self:copy():roundi()
end

-----------------------------------------------------------
-- interpolation
-----------------------------------------------------------

function vec2:lerpi(other, amount)
	self.x = math.lerp(self.x, other.x, amount)
	self.y = math.lerp(self.y, other.y, amount)
	return self
end

function vec2:lerp(other, amount)
	return self:copy():lerpi(other, amount)
end

-----------------------------------------------------------
-- vector products and projections
-----------------------------------------------------------

function vec2.dot(a, b)
	return a.x * b.x + a.y * b.y
end

--"fake", but useful - also called the wedge product apparently
function vec2.cross(a, b)
	return a.x * b.y - a.y * b.x
end

--scalar projection a onto b
function vec2.sproj(a, b)
	local len = b:length()
	if len == 0 then
		return 0
	end
	return a:dot(b) / len
end

--vector projection a onto b (writes into a)
function vec2.vproji(a, b)
	local div = b:dot(b)
	if div == 0 then
		return a:sset(0,0)
	end
	local fac = a:dot(b) / div
	return a:vset(b):smuli(fac)
end

function vec2.vproj(a, b)
	return a:copy():vproji(b)
end

--vector rejection a onto b (writes into a)
function vec2.vreji(a, b)
	local tx, ty = a.x, a.y
	a:vproji(b)
	a:sset(tx - a.x, ty - a.y)
	return a
end

function vec2.vrej(a, b)
	return a:copy():vreji(b)
end

-----------------------------------------------------------
-- vector extension methods for special purposes
--   (any common vector ops worth naming)
-----------------------------------------------------------

--"physical" friction
local _v_friction = vec2:zero() --avoid alloc
function vec2:apply_friction(mu, dt)
	_v_friction:vset(self):smuli(mu * dt)
	if _v_friction:length_squared() > self:length_squared() then
		self:sset(0, 0)
	else
		self:vsubi(_v_friction)
	end
	return self
end

--"gamey" friction in one dimension
function apply_friction_1d(v, mu, dt)
	local friction = mu * v * dt
	if math.abs(friction) > math.abs(v) then
		return 0
	else
		return v - friction
	end
end

--"gamey" friction in both dimensions
function vec2:apply_friction_xy(mu_x, mu_y, dt)
	self.x = apply_friction_1d(self.x, mu_x, dt)
	self.y = apply_friction_1d(self.y, mu_y, dt)
	return self
end

return vec2