use super::Vector3;
use std::ops::{Add, Mul, Neg, Sub};
#[derive(Debug, Clone, Copy, PartialEq)]
pub struct Vector4 {
pub x: f32,
pub y: f32,
pub z: f32,
pub w: f32,
}
impl Vector4 {
pub const ZERO: Self = Self {
x: 0.0,
y: 0.0,
z: 0.0,
w: 0.0,
};
pub const ONE: Self = Self {
x: 1.0,
y: 1.0,
z: 1.0,
w: 1.0,
};
pub const fn new(x: f32, y: f32, z: f32, w: f32) -> Self {
Self { x, y, z, w }
}
pub fn from_vec3(v: Vector3, w: f32) -> Self {
Self {
x: v.x,
y: v.y,
z: v.z,
w,
}
}
pub fn set(&mut self, x: f32, y: f32, z: f32, w: f32) -> &mut Self {
self.x = x;
self.y = y;
self.z = z;
self.w = w;
self
}
pub fn length(&self) -> f32 {
self.length_sq().sqrt()
}
pub fn length_sq(&self) -> f32 {
self.x * self.x + self.y * self.y + self.z * self.z + self.w * self.w
}
pub fn normalize(&self) -> Self {
let len = self.length();
if len == 0.0 {
Self::ZERO
} else {
*self * (1.0 / len)
}
}
pub fn dot(&self, other: Self) -> f32 {
self.x * other.x + self.y * other.y + self.z * other.z + self.w * other.w
}
pub fn lerp(&self, other: Self, t: f32) -> Self {
*self + (other - *self) * t
}
pub fn xyz(&self) -> Vector3 {
Vector3::new(self.x, self.y, self.z)
}
pub fn to_array(&self) -> [f32; 4] {
[self.x, self.y, self.z, self.w]
}
}
impl Add for Vector4 {
type Output = Self;
fn add(self, rhs: Self) -> Self {
Self::new(
self.x + rhs.x,
self.y + rhs.y,
self.z + rhs.z,
self.w + rhs.w,
)
}
}
impl Sub for Vector4 {
type Output = Self;
fn sub(self, rhs: Self) -> Self {
Self::new(
self.x - rhs.x,
self.y - rhs.y,
self.z - rhs.z,
self.w - rhs.w,
)
}
}
impl Mul<f32> for Vector4 {
type Output = Self;
fn mul(self, rhs: f32) -> Self {
Self::new(self.x * rhs, self.y * rhs, self.z * rhs, self.w * rhs)
}
}
impl Neg for Vector4 {
type Output = Self;
fn neg(self) -> Self {
Self::new(-self.x, -self.y, -self.z, -self.w)
}
}
#[cfg(test)]
mod tests {
use super::*;
#[test]
fn normalize_unit_length() {
let v = Vector4::new(1.0, 2.0, 3.0, 4.0).normalize();
assert!((v.length() - 1.0).abs() < 1e-6);
}
#[test]
fn xyz_drops_w() {
let v = Vector4::new(1.0, 2.0, 3.0, 99.0);
assert_eq!(v.xyz(), Vector3::new(1.0, 2.0, 3.0));
}
}