use crate::{BVec4, DVec2, DVec3, UnitDVec4};
#[cfg(not(target_arch = "spirv"))]
use core::fmt;
use core::iter::{Product, Sum};
use core::ops::*;
use crate::nums::*;
use auto_ops_det::impl_op_ex;
use core::ops;
#[inline]
pub const fn dvec4(x: f64, y: f64, z: f64, w: f64) -> DVec4 {
DVec4::new(x, y, z, w)
}
#[derive(Clone, Copy, PartialEq)]
#[cfg_attr(feature = "cuda", repr(align(16)))]
#[cfg_attr(not(target_arch = "spirv"), repr(C))]
#[cfg_attr(target_arch = "spirv", repr(simd))]
pub struct DVec4 {
pub x: f64,
pub y: f64,
pub z: f64,
pub w: f64,
}
impl DVec4 {
pub const ZERO: Self = Self::splat(0.0_f64);
pub const ONE: Self = Self::splat(1.0_f64);
pub const NEG_ONE: Self = Self::splat(-1.0_f64);
pub const NAN: Self = Self::splat(f64::NAN);
pub const X: Self = Self::new(1.0_f64, 0.0_f64, 0.0_f64, 0.0_f64);
pub const Y: Self = Self::new(0.0_f64, 1.0_f64, 0.0_f64, 0.0_f64);
pub const Z: Self = Self::new(0.0_f64, 0.0_f64, 1.0_f64, 0.0_f64);
pub const W: Self = Self::new(0.0_f64, 0.0_f64, 0.0_f64, 1.0_f64);
pub const NEG_X: Self = Self::new(-1.0_f64, 0.0_f64, 0.0_f64, 0.0_f64);
pub const NEG_Y: Self = Self::new(0.0_f64, -1.0_f64, 0.0_f64, 0.0_f64);
pub const NEG_Z: Self = Self::new(0.0_f64, 0.0_f64, -1.0_f64, 0.0_f64);
pub const NEG_W: Self = Self::new(0.0_f64, 0.0_f64, 0.0_f64, -1.0_f64);
pub const AXES: [Self; 4] = [Self::X, Self::Y, Self::Z, Self::W];
#[inline]
pub const fn new(x: f64, y: f64, z: f64, w: f64) -> Self {
Self { x, y, z, w }
}
#[inline]
pub const fn splat(v: f64) -> Self {
Self {
x: v,
y: v,
z: v,
w: v,
}
}
#[inline]
pub fn select(mask: BVec4, if_true: Self, if_false: Self) -> Self {
Self {
x: if mask.x { if_true.x } else { if_false.x },
y: if mask.y { if_true.y } else { if_false.y },
z: if mask.z { if_true.z } else { if_false.z },
w: if mask.w { if_true.w } else { if_false.w },
}
}
#[inline]
pub const fn from_array(a: [f64; 4]) -> Self {
Self::new(a[0], a[1], a[2], a[3])
}
#[inline]
pub const fn to_array(&self) -> [f64; 4] {
[self.x, self.y, self.z, self.w]
}
#[inline]
pub const fn from_slice(slice: &[f64]) -> Self {
Self::new(slice[0], slice[1], slice[2], slice[3])
}
#[inline]
pub fn write_to_slice(self, slice: &mut [f64]) {
slice[0] = self.x;
slice[1] = self.y;
slice[2] = self.z;
slice[3] = self.w;
}
#[inline]
pub fn truncate(self) -> DVec3 {
use crate::swizzles::Vec4Swizzles;
self.xyz()
}
#[inline]
pub(crate) fn dot(self, rhs: Self) -> f64 {
(self.x * rhs.x) + (self.y * rhs.y) + (self.z * rhs.z) + (self.w * rhs.w)
}
#[inline]
pub fn min(self, rhs: Self) -> Self {
Self {
x: self.x.minf(rhs.x),
y: self.y.minf(rhs.y),
z: self.z.minf(rhs.z),
w: self.w.minf(rhs.w),
}
}
#[inline]
pub fn max(self, rhs: Self) -> Self {
Self {
x: self.x.maxf(rhs.x),
y: self.y.maxf(rhs.y),
z: self.z.maxf(rhs.z),
w: self.w.maxf(rhs.w),
}
}
#[inline]
pub fn clamp(self, min: Self, max: Self) -> Self {
glam_assert!(min.cmple(max).all(), "clamp: expected min <= max");
self.max(min).min(max)
}
#[inline]
pub fn min_element(self) -> f64 {
self.x.minf(self.y.minf(self.z.minf(self.w)))
}
#[inline]
pub fn max_element(self) -> f64 {
self.x.maxf(self.y.maxf(self.z.maxf(self.w)))
}
#[inline]
pub fn cmpeq(self, rhs: Self) -> BVec4 {
BVec4::new(
self.x.eq(&rhs.x),
self.y.eq(&rhs.y),
self.z.eq(&rhs.z),
self.w.eq(&rhs.w),
)
}
#[inline]
pub fn cmpne(self, rhs: Self) -> BVec4 {
BVec4::new(
self.x.ne(&rhs.x),
self.y.ne(&rhs.y),
self.z.ne(&rhs.z),
self.w.ne(&rhs.w),
)
}
#[inline]
pub fn cmpge(self, rhs: Self) -> BVec4 {
BVec4::new(
self.x.ge(&rhs.x),
self.y.ge(&rhs.y),
self.z.ge(&rhs.z),
self.w.ge(&rhs.w),
)
}
#[inline]
pub fn cmpgt(self, rhs: Self) -> BVec4 {
BVec4::new(
self.x.gt(&rhs.x),
self.y.gt(&rhs.y),
self.z.gt(&rhs.z),
self.w.gt(&rhs.w),
)
}
#[inline]
pub fn cmple(self, rhs: Self) -> BVec4 {
BVec4::new(
self.x.le(&rhs.x),
self.y.le(&rhs.y),
self.z.le(&rhs.z),
self.w.le(&rhs.w),
)
}
#[inline]
pub fn cmplt(self, rhs: Self) -> BVec4 {
BVec4::new(
self.x.lt(&rhs.x),
self.y.lt(&rhs.y),
self.z.lt(&rhs.z),
self.w.lt(&rhs.w),
)
}
#[inline]
pub fn abs(self) -> Self {
Self {
x: self.x.absf(),
y: self.y.absf(),
z: self.z.absf(),
w: self.w.absf(),
}
}
#[inline]
pub fn signum(self) -> Self {
Self {
x: self.x.signumf(),
y: self.y.signumf(),
z: self.z.signumf(),
w: self.w.signumf(),
}
}
#[inline]
pub fn is_finite(self) -> bool {
self.x.is_finite() && self.y.is_finite() && self.z.is_finite() && self.w.is_finite()
}
#[inline]
pub fn is_nan(self) -> bool {
self.x.is_nan() || self.y.is_nan() || self.z.is_nan() || self.w.is_nan()
}
#[inline]
pub fn is_nan_mask(self) -> BVec4 {
BVec4::new(
self.x.is_nan(),
self.y.is_nan(),
self.z.is_nan(),
self.w.is_nan(),
)
}
#[inline]
pub fn round(self) -> Self {
Self {
x: self.x.roundf(),
y: self.y.roundf(),
z: self.z.roundf(),
w: self.w.roundf(),
}
}
#[inline]
pub fn floor(self) -> Self {
Self {
x: self.x.floorf(),
y: self.y.floorf(),
z: self.z.floorf(),
w: self.w.floorf(),
}
}
#[inline]
pub fn ceil(self) -> Self {
Self {
x: self.x.ceilf(),
y: self.y.ceilf(),
z: self.z.ceilf(),
w: self.w.ceilf(),
}
}
#[inline]
pub fn fract(self) -> Self {
self - self.floor()
}
#[inline]
pub fn exp(self) -> Self {
Self::new(self.x.expf(), self.y.expf(), self.z.expf(), self.w.expf())
}
#[inline]
pub fn powf(self, n: f64) -> Self {
Self::new(
self.x.powff(n),
self.y.powff(n),
self.z.powff(n),
self.w.powff(n),
)
}
#[inline]
pub fn recip(self) -> Self {
Self {
x: self.x.recip(),
y: self.y.recip(),
z: self.z.recip(),
w: self.w.recip(),
}
}
#[doc(alias = "magnitude")]
#[inline]
pub fn length(self) -> f64 {
self.dot(self).sqrtf()
}
#[doc(alias = "magnitude2")]
#[inline]
pub fn length_squared(self) -> f64 {
self.dot(self)
}
#[inline]
pub fn length_recip(self) -> f64 {
self.length().recip()
}
#[inline]
pub fn distance(self, rhs: Self) -> f64 {
(self - rhs).length()
}
#[inline]
pub fn distance_squared(self, rhs: Self) -> f64 {
(self - rhs).length_squared()
}
#[must_use]
#[inline]
pub fn normalize(self) -> Self {
let length = self.length();
glam_assert!(length.gt(&0.0_f64), "Trying to normalize {:?}", self);
glam_assert!(self.is_finite(), "Trying to normalize {:?}", self);
glam_assert!(length.is_finite(), "Trying to normalize {:?}", self);
#[allow(clippy::let_and_return)]
let normalized = self.mul(length.recip());
glam_assert!(normalized.is_finite(), "Trying to normalize {:?}", self);
normalized
}
#[must_use]
#[inline]
pub fn normalize_and_length(self) -> (Self, f64) {
#[allow(clippy::let_and_return)]
let length = self.length();
glam_assert!(length.gt(&0.0_f64), "Trying to normalize {:?}", self);
glam_assert!(self.is_finite(), "Trying to normalize {:?}", self);
glam_assert!(length.is_finite(), "Trying to normalize {:?}", self);
let normalized = self.mul(length.recip());
glam_assert!(normalized.is_finite(), "Trying to normalize {:?}", self);
(normalized, length)
}
#[must_use]
#[inline]
pub fn normalize_to_unit(self) -> UnitDVec4 {
self.normalize().as_unit_dvec4_unchecked()
}
#[must_use]
#[inline]
pub fn normalize_to_unit_and_length(self) -> (UnitDVec4, f64) {
let res = self.normalize_and_length();
(res.0.as_unit_dvec4_unchecked(), res.1)
}
#[must_use]
#[inline]
pub fn try_normalize(self, min_len: f64) -> Option<Self> {
let length = self.length();
if length.is_finite() && length > min_len {
Some(self * length.recip())
} else {
None
}
}
#[must_use]
#[inline]
pub fn try_normalize_to_unit(self, min_len: f64) -> Option<UnitDVec4> {
let length = self.length();
if length.is_finite() && length > min_len {
Some((self * length.recip()).as_unit_dvec4_unchecked())
} else {
None
}
}
#[must_use]
#[inline]
pub fn try_normalize_to_unit_and_length(self, min_len: f64) -> Option<(UnitDVec4, f64)> {
let length = self.length();
if length.is_finite() && length > min_len {
Some(((self * length.recip()).as_unit_dvec4_unchecked(), length))
} else {
None
}
}
#[must_use]
#[inline]
pub fn normalize_or_zero(self) -> Self {
let rcp = self.length_recip();
if rcp.is_finite() && rcp > 0.0 {
self * rcp
} else {
Self::ZERO
}
}
#[inline]
pub fn is_normalized(self) -> bool {
(self.length_squared() - 1.0_f64).absf() <= 1e-4
}
#[must_use]
#[inline]
pub fn project_onto(self, rhs: Self) -> Self {
let other_len_sq_rcp = rhs.dot(rhs).recip();
glam_assert!(
other_len_sq_rcp.is_finite(),
"Trying to project onto infinite rhs = {:?}",
rhs
);
rhs * self.dot(rhs) * other_len_sq_rcp
}
#[must_use]
#[inline]
pub fn reject_from(self, rhs: Self) -> Self {
self - self.project_onto(rhs)
}
#[must_use]
#[inline]
pub fn project_onto_normalized(self, rhs: UnitDVec4) -> Self {
rhs.as_dvec4() * self.dot(rhs.as_dvec4())
}
#[must_use]
#[inline]
pub fn reject_from_normalized(self, rhs: UnitDVec4) -> Self {
self - self.project_onto_normalized(rhs)
}
#[doc(alias = "mix")]
#[inline]
pub fn lerp(self, rhs: Self, s: f64) -> Self {
self + ((rhs - self) * s)
}
#[inline]
pub fn abs_diff_eq(self, rhs: Self, max_abs_diff: f64) -> bool {
self.sub(rhs).abs().cmple(Self::splat(max_abs_diff)).all()
}
#[inline]
pub fn clamp_length(self, min: f64, max: f64) -> Self {
glam_assert!(min <= max);
let length_sq = self.length_squared();
if length_sq < min * min {
self * (length_sq.sqrtf().recip() * min)
} else if length_sq > max * max {
self * (length_sq.sqrtf().recip() * max)
} else {
self
}
}
#[inline]
pub fn clamp_length_max(self, max: f64) -> Self {
let length_sq = self.length_squared();
if length_sq > max * max {
self * (length_sq.sqrtf().recip() * max)
} else {
self
}
}
#[inline]
pub fn clamp_length_min(self, min: f64) -> Self {
let length_sq = self.length_squared();
if length_sq < min * min {
self * (length_sq.sqrtf().recip() * min)
} else {
self
}
}
#[inline]
pub fn mul_add(self, a: Self, b: Self) -> Self {
Self::new(
self.x.mul_addf(a.x, b.x),
self.y.mul_addf(a.y, b.y),
self.z.mul_addf(a.z, b.z),
self.w.mul_addf(a.w, b.w),
)
}
#[inline]
pub fn as_vec4(&self) -> crate::Vec4 {
crate::Vec4::new(self.x as f32, self.y as f32, self.z as f32, self.w as f32)
}
#[inline]
pub fn as_ivec4(&self) -> crate::IVec4 {
crate::IVec4::new(self.x as i32, self.y as i32, self.z as i32, self.w as i32)
}
#[inline]
pub fn as_uvec4(&self) -> crate::UVec4 {
crate::UVec4::new(self.x as u32, self.y as u32, self.z as u32, self.w as u32)
}
}
impl Default for DVec4 {
#[inline]
fn default() -> Self {
Self::ZERO
}
}
impl_op_ex!(/ |a: &DVec4, b: &DVec4| -> DVec4 {
DVec4 {
x: a.x.div(b.x),
y: a.y.div(b.y),
z: a.z.div(b.z),
w: a.w.div(b.w),
}
});
impl_op_ex!(/= |a: &mut DVec4, b: &DVec4| {
a.x.div_assign(b.x);
a.y.div_assign(b.y);
a.z.div_assign(b.z);
a.w.div_assign(b.w);
});
impl_op_ex!(/ |a: &DVec4, b: &f64| -> DVec4 {
DVec4 {
x: a.x.div(b),
y: a.y.div(b),
z: a.z.div(b),
w: a.w.div(b),
}
});
impl_op_ex!(/= |a: &mut DVec4, b: &f64| {
a.x.div_assign(b);
a.y.div_assign(b);
a.z.div_assign(b);
a.w.div_assign(b);
});
impl_op_ex!(/ |a: &f64, b: &DVec4| -> DVec4 {
DVec4 {
x: a.div(b.x),
y: a.div(b.y),
z: a.div(b.z),
w: a.div(b.w),
}
});
impl_op_ex!(*|a: &DVec4, b: &DVec4| -> DVec4 {
DVec4 {
x: a.x.mul(b.x),
y: a.y.mul(b.y),
z: a.z.mul(b.z),
w: a.w.mul(b.w),
}
});
impl_op_ex!(*= |a: &mut DVec4, b: &DVec4| {
a.x.mul_assign(b.x);
a.y.mul_assign(b.y);
a.z.mul_assign(b.z);
a.w.mul_assign(b.w);
});
impl_op_ex!(*|a: &DVec4, b: &f64| -> DVec4 {
DVec4 {
x: a.x.mul(b),
y: a.y.mul(b),
z: a.z.mul(b),
w: a.w.mul(b),
}
});
impl_op_ex!(*= |a: &mut DVec4, b: &f64| {
a.x.mul_assign(b);
a.y.mul_assign(b);
a.z.mul_assign(b);
a.w.mul_assign(b);
});
impl_op_ex!(*|a: &f64, b: &DVec4| -> DVec4 {
DVec4 {
x: a.mul(b.x),
y: a.mul(b.y),
z: a.mul(b.z),
w: a.mul(b.w),
}
});
impl_op_ex!(+ |a: &DVec4, b: &DVec4| -> DVec4 {
DVec4 {
x: a.x.add(b.x),
y: a.y.add(b.y),
z: a.z.add(b.z),
w: a.w.add(b.w),
}
});
impl_op_ex!(+= |a: &mut DVec4, b: &DVec4| {
a.x.add_assign(b.x);
a.y.add_assign(b.y);
a.z.add_assign(b.z);
a.w.add_assign(b.w);
});
impl_op_ex!(+ |a: &DVec4, b: &f64| -> DVec4 {
DVec4 {
x: a.x.add(b),
y: a.y.add(b),
z: a.z.add(b),
w: a.w.add(b),
}
});
impl_op_ex!(+= |a: &mut DVec4, b: &f64| {
a.x.add_assign(b);
a.y.add_assign(b);
a.z.add_assign(b);
a.w.add_assign(b);
});
impl_op_ex!(+ |a: &f64, b: &DVec4| -> DVec4 {
DVec4 {
x: a.add(b.x),
y: a.add(b.y),
z: a.add(b.z),
w: a.add(b.w),
}
});
impl_op_ex!(-|a: &DVec4, b: &DVec4| -> DVec4 {
DVec4 {
x: a.x.sub(b.x),
y: a.y.sub(b.y),
z: a.z.sub(b.z),
w: a.w.sub(b.w),
}
});
impl_op_ex!(-= |a: &mut DVec4, b: &DVec4| {
a.x.sub_assign(b.x);
a.y.sub_assign(b.y);
a.z.sub_assign(b.z);
a.w.sub_assign(b.w);
});
impl_op_ex!(-|a: &DVec4, b: &f64| -> DVec4 {
DVec4 {
x: a.x.sub(b),
y: a.y.sub(b),
z: a.z.sub(b),
w: a.w.sub(b),
}
});
impl_op_ex!(-= |a: &mut DVec4, b: &f64| {
a.x.sub_assign(b);
a.y.sub_assign(b);
a.z.sub_assign(b);
a.w.sub_assign(b);
});
impl_op_ex!(-|a: &f64, b: &DVec4| -> DVec4 {
DVec4 {
x: a.sub(b.x),
y: a.sub(b.y),
z: a.sub(b.z),
w: a.sub(b.w),
}
});
impl_op_ex!(% |a: &DVec4, b: &DVec4| -> DVec4 {
DVec4 {
x: a.x.rem(b.x),
y: a.y.rem(b.y),
z: a.z.rem(b.z),
w: a.w.rem(b.w),
}
});
impl_op_ex!(%= |a: &mut DVec4, b: &DVec4| {
a.x.rem_assign(b.x);
a.y.rem_assign(b.y);
a.z.rem_assign(b.z);
a.w.rem_assign(b.w);
});
impl_op_ex!(% |a: &DVec4, b: &f64| -> DVec4 {
DVec4 {
x: a.x.rem(b),
y: a.y.rem(b),
z: a.z.rem(b),
w: a.w.rem(b),
}
});
impl_op_ex!(%= |a: &mut DVec4, b: &f64| {
a.x.rem_assign(b);
a.y.rem_assign(b);
a.z.rem_assign(b);
a.w.rem_assign(b);
});
impl_op_ex!(% |a: &f64, b: &DVec4| -> DVec4 {
DVec4 {
x: a.rem(b.x),
y: a.rem(b.y),
z: a.rem(b.z),
w: a.rem(b.w),
}
});
impl<'a> Sum<&'a Self> for DVec4 {
#[inline]
fn sum<I>(iter: I) -> Self
where
I: Iterator<Item = &'a Self>,
{
iter.fold(Self::ZERO, |a, &b| Self::add(a, b))
}
}
impl<'a> Product<&'a Self> for DVec4 {
#[inline]
fn product<I>(iter: I) -> Self
where
I: Iterator<Item = &'a Self>,
{
iter.fold(Self::ONE, |a, &b| Self::mul(a, b))
}
}
impl Neg for DVec4 {
type Output = Self;
#[inline]
fn neg(self) -> Self {
Self {
x: self.x.neg(),
y: self.y.neg(),
z: self.z.neg(),
w: self.w.neg(),
}
}
}
impl Index<usize> for DVec4 {
type Output = f64;
#[inline]
fn index(&self, index: usize) -> &Self::Output {
match index {
0 => &self.x,
1 => &self.y,
2 => &self.z,
3 => &self.w,
_ => panic!("index out of bounds"),
}
}
}
impl IndexMut<usize> for DVec4 {
#[inline]
fn index_mut(&mut self, index: usize) -> &mut Self::Output {
match index {
0 => &mut self.x,
1 => &mut self.y,
2 => &mut self.z,
3 => &mut self.w,
_ => panic!("index out of bounds"),
}
}
}
#[cfg(not(target_arch = "spirv"))]
impl fmt::Display for DVec4 {
fn fmt(&self, f: &mut fmt::Formatter<'_>) -> fmt::Result {
write!(f, "[{}, {}, {}, {}]", self.x, self.y, self.z, self.w)
}
}
#[cfg(not(target_arch = "spirv"))]
impl fmt::Debug for DVec4 {
fn fmt(&self, fmt: &mut fmt::Formatter<'_>) -> fmt::Result {
fmt.debug_tuple(stringify!(DVec4))
.field(&self.x)
.field(&self.y)
.field(&self.z)
.field(&self.w)
.finish()
}
}
impl From<[f64; 4]> for DVec4 {
#[inline]
fn from(a: [f64; 4]) -> Self {
Self::new(a[0], a[1], a[2], a[3])
}
}
impl From<DVec4> for [f64; 4] {
#[inline]
fn from(v: DVec4) -> Self {
[v.x, v.y, v.z, v.w]
}
}
impl From<(f64, f64, f64, f64)> for DVec4 {
#[inline]
fn from(t: (f64, f64, f64, f64)) -> Self {
Self::new(t.0, t.1, t.2, t.3)
}
}
impl From<DVec4> for (f64, f64, f64, f64) {
#[inline]
fn from(v: DVec4) -> Self {
(v.x, v.y, v.z, v.w)
}
}
impl From<(DVec3, f64)> for DVec4 {
#[inline]
fn from((v, w): (DVec3, f64)) -> Self {
Self::new(v.x, v.y, v.z, w)
}
}
impl From<(f64, DVec3)> for DVec4 {
#[inline]
fn from((x, v): (f64, DVec3)) -> Self {
Self::new(x, v.x, v.y, v.z)
}
}
impl From<(DVec2, f64, f64)> for DVec4 {
#[inline]
fn from((v, z, w): (DVec2, f64, f64)) -> Self {
Self::new(v.x, v.y, z, w)
}
}
impl From<(DVec2, DVec2)> for DVec4 {
#[inline]
fn from((v, u): (DVec2, DVec2)) -> Self {
Self::new(v.x, v.y, u.x, u.y)
}
}
#[cfg(not(target_arch = "spirv"))]
impl AsRef<[f64; 4]> for DVec4 {
#[inline]
fn as_ref(&self) -> &[f64; 4] {
unsafe { &*(self as *const DVec4 as *const [f64; 4]) }
}
}
#[cfg(not(target_arch = "spirv"))]
impl AsMut<[f64; 4]> for DVec4 {
#[inline]
fn as_mut(&mut self) -> &mut [f64; 4] {
unsafe { &mut *(self as *mut DVec4 as *mut [f64; 4]) }
}
}