1#[cfg(feature = "f64")]
4use crate::DMat3;
5
6use crate::{
7 EulerRot, Mat2, Mat3, Mat4, Quat, Vec2, Vec3, Vec3A,
8 euler::{FromEuler, ToEuler},
9 f32::math,
10 swizzles::*,
11};
12use core::fmt;
13use core::iter::{Product, Sum};
14use core::ops::{Add, AddAssign, Div, DivAssign, Mul, MulAssign, Neg, Sub, SubAssign};
15
16#[cfg(target_arch = "x86")]
17use core::arch::x86::*;
18#[cfg(target_arch = "x86_64")]
19use core::arch::x86_64::*;
20
21#[cfg(feature = "zerocopy-08")]
22use zerocopy_derive_08::*;
23
24#[inline(always)]
26#[must_use]
27pub const fn mat3a(x_axis: Vec3A, y_axis: Vec3A, z_axis: Vec3A) -> Mat3A {
28 Mat3A::from_cols(x_axis, y_axis, z_axis)
29}
30
31#[derive(Clone, Copy)]
60#[cfg_attr(feature = "bytemuck", derive(bytemuck::Pod, bytemuck::Zeroable))]
61#[cfg_attr(
62 feature = "zerocopy-08",
63 derive(FromBytes, Immutable, IntoBytes, KnownLayout)
64)]
65#[repr(C)]
66pub struct Mat3A {
67 pub x_axis: Vec3A,
68 pub y_axis: Vec3A,
69 pub z_axis: Vec3A,
70}
71
72impl Mat3A {
73 pub const ZERO: Self = Self::from_cols(Vec3A::ZERO, Vec3A::ZERO, Vec3A::ZERO);
75
76 pub const IDENTITY: Self = Self::from_cols(Vec3A::X, Vec3A::Y, Vec3A::Z);
78
79 pub const NAN: Self = Self::from_cols(Vec3A::NAN, Vec3A::NAN, Vec3A::NAN);
81
82 #[allow(clippy::too_many_arguments)]
83 #[inline(always)]
84 #[must_use]
85 const fn new(
86 m00: f32,
87 m01: f32,
88 m02: f32,
89 m10: f32,
90 m11: f32,
91 m12: f32,
92 m20: f32,
93 m21: f32,
94 m22: f32,
95 ) -> Self {
96 Self {
97 x_axis: Vec3A::new(m00, m01, m02),
98 y_axis: Vec3A::new(m10, m11, m12),
99 z_axis: Vec3A::new(m20, m21, m22),
100 }
101 }
102
103 #[inline(always)]
107 #[must_use]
108 pub const fn from_cols(x_axis: Vec3A, y_axis: Vec3A, z_axis: Vec3A) -> Self {
109 Self {
110 x_axis,
111 y_axis,
112 z_axis,
113 }
114 }
115
116 #[inline(always)]
122 #[must_use]
123 pub const fn from_rows(row0: Vec3A, row1: Vec3A, row2: Vec3A) -> Self {
124 let [m00, m01, m02] = row0.to_array();
125 let [m10, m11, m12] = row1.to_array();
126 let [m20, m21, m22] = row2.to_array();
127 Self::new(m00, m10, m20, m01, m11, m21, m02, m12, m22)
128 }
129
130 #[inline]
134 #[must_use]
135 pub const fn from_cols_array(m: &[f32; 9]) -> Self {
136 Self::new(m[0], m[1], m[2], m[3], m[4], m[5], m[6], m[7], m[8])
137 }
138
139 #[inline]
143 #[must_use]
144 pub const fn to_cols_array(&self) -> [f32; 9] {
145 let [x_axis_x, x_axis_y, x_axis_z] = self.x_axis.to_array();
146 let [y_axis_x, y_axis_y, y_axis_z] = self.y_axis.to_array();
147 let [z_axis_x, z_axis_y, z_axis_z] = self.z_axis.to_array();
148
149 [
150 x_axis_x, x_axis_y, x_axis_z, y_axis_x, y_axis_y, y_axis_z, z_axis_x, z_axis_y,
151 z_axis_z,
152 ]
153 }
154
155 #[inline]
159 #[must_use]
160 pub const fn from_cols_array_2d(m: &[[f32; 3]; 3]) -> Self {
161 Self::from_cols(
162 Vec3A::from_array(m[0]),
163 Vec3A::from_array(m[1]),
164 Vec3A::from_array(m[2]),
165 )
166 }
167
168 #[inline]
172 #[must_use]
173 pub const fn to_cols_array_2d(&self) -> [[f32; 3]; 3] {
174 [
175 self.x_axis.to_array(),
176 self.y_axis.to_array(),
177 self.z_axis.to_array(),
178 ]
179 }
180
181 #[inline]
187 #[must_use]
188 pub const fn from_rows_array(m: &[f32; 9]) -> Self {
189 Self::new(m[0], m[3], m[6], m[1], m[4], m[7], m[2], m[5], m[8])
190 }
191
192 #[inline]
198 #[must_use]
199 pub const fn to_rows_array(&self) -> [f32; 9] {
200 let m = self.to_cols_array();
201 [m[0], m[3], m[6], m[1], m[4], m[7], m[2], m[5], m[8]]
202 }
203
204 #[doc(alias = "scale")]
206 #[inline]
207 #[must_use]
208 pub const fn from_diagonal(diagonal: Vec3) -> Self {
209 Self::new(
210 diagonal.x, 0.0, 0.0, 0.0, diagonal.y, 0.0, 0.0, 0.0, diagonal.z,
211 )
212 }
213
214 #[inline]
216 #[must_use]
217 pub fn from_mat4(m: Mat4) -> Self {
218 Self::from_cols(
219 Vec3A::from_vec4(m.x_axis),
220 Vec3A::from_vec4(m.y_axis),
221 Vec3A::from_vec4(m.z_axis),
222 )
223 }
224
225 #[inline]
232 #[must_use]
233 #[track_caller]
234 pub fn from_mat4_minor(m: Mat4, i: usize, j: usize) -> Self {
235 match (i, j) {
236 (0, 0) => Self::from_cols(
237 Vec3A::from_vec4(m.y_axis.yzww()),
238 Vec3A::from_vec4(m.z_axis.yzww()),
239 Vec3A::from_vec4(m.w_axis.yzww()),
240 ),
241 (0, 1) => Self::from_cols(
242 Vec3A::from_vec4(m.y_axis.xzww()),
243 Vec3A::from_vec4(m.z_axis.xzww()),
244 Vec3A::from_vec4(m.w_axis.xzww()),
245 ),
246 (0, 2) => Self::from_cols(
247 Vec3A::from_vec4(m.y_axis.xyww()),
248 Vec3A::from_vec4(m.z_axis.xyww()),
249 Vec3A::from_vec4(m.w_axis.xyww()),
250 ),
251 (0, 3) => Self::from_cols(
252 Vec3A::from_vec4(m.y_axis.xyzw()),
253 Vec3A::from_vec4(m.z_axis.xyzw()),
254 Vec3A::from_vec4(m.w_axis.xyzw()),
255 ),
256 (1, 0) => Self::from_cols(
257 Vec3A::from_vec4(m.x_axis.yzww()),
258 Vec3A::from_vec4(m.z_axis.yzww()),
259 Vec3A::from_vec4(m.w_axis.yzww()),
260 ),
261 (1, 1) => Self::from_cols(
262 Vec3A::from_vec4(m.x_axis.xzww()),
263 Vec3A::from_vec4(m.z_axis.xzww()),
264 Vec3A::from_vec4(m.w_axis.xzww()),
265 ),
266 (1, 2) => Self::from_cols(
267 Vec3A::from_vec4(m.x_axis.xyww()),
268 Vec3A::from_vec4(m.z_axis.xyww()),
269 Vec3A::from_vec4(m.w_axis.xyww()),
270 ),
271 (1, 3) => Self::from_cols(
272 Vec3A::from_vec4(m.x_axis.xyzw()),
273 Vec3A::from_vec4(m.z_axis.xyzw()),
274 Vec3A::from_vec4(m.w_axis.xyzw()),
275 ),
276 (2, 0) => Self::from_cols(
277 Vec3A::from_vec4(m.x_axis.yzww()),
278 Vec3A::from_vec4(m.y_axis.yzww()),
279 Vec3A::from_vec4(m.w_axis.yzww()),
280 ),
281 (2, 1) => Self::from_cols(
282 Vec3A::from_vec4(m.x_axis.xzww()),
283 Vec3A::from_vec4(m.y_axis.xzww()),
284 Vec3A::from_vec4(m.w_axis.xzww()),
285 ),
286 (2, 2) => Self::from_cols(
287 Vec3A::from_vec4(m.x_axis.xyww()),
288 Vec3A::from_vec4(m.y_axis.xyww()),
289 Vec3A::from_vec4(m.w_axis.xyww()),
290 ),
291 (2, 3) => Self::from_cols(
292 Vec3A::from_vec4(m.x_axis.xyzw()),
293 Vec3A::from_vec4(m.y_axis.xyzw()),
294 Vec3A::from_vec4(m.w_axis.xyzw()),
295 ),
296 (3, 0) => Self::from_cols(
297 Vec3A::from_vec4(m.x_axis.yzww()),
298 Vec3A::from_vec4(m.y_axis.yzww()),
299 Vec3A::from_vec4(m.z_axis.yzww()),
300 ),
301 (3, 1) => Self::from_cols(
302 Vec3A::from_vec4(m.x_axis.xzww()),
303 Vec3A::from_vec4(m.y_axis.xzww()),
304 Vec3A::from_vec4(m.z_axis.xzww()),
305 ),
306 (3, 2) => Self::from_cols(
307 Vec3A::from_vec4(m.x_axis.xyww()),
308 Vec3A::from_vec4(m.y_axis.xyww()),
309 Vec3A::from_vec4(m.z_axis.xyww()),
310 ),
311 (3, 3) => Self::from_cols(
312 Vec3A::from_vec4(m.x_axis.xyzw()),
313 Vec3A::from_vec4(m.y_axis.xyzw()),
314 Vec3A::from_vec4(m.z_axis.xyzw()),
315 ),
316 _ => panic!("index out of bounds"),
317 }
318 }
319
320 #[inline]
326 #[must_use]
327 #[cfg_attr(any(debug_assertions, feature = "glam-assert"), track_caller)]
328 pub fn from_quat(rotation: Quat) -> Self {
329 glam_assert!(rotation.is_normalized());
330
331 let x2 = rotation.x + rotation.x;
332 let y2 = rotation.y + rotation.y;
333 let z2 = rotation.z + rotation.z;
334 let xx = rotation.x * x2;
335 let xy = rotation.x * y2;
336 let xz = rotation.x * z2;
337 let yy = rotation.y * y2;
338 let yz = rotation.y * z2;
339 let zz = rotation.z * z2;
340 let wx = rotation.w * x2;
341 let wy = rotation.w * y2;
342 let wz = rotation.w * z2;
343
344 Self::from_cols(
345 Vec3A::new(1.0 - (yy + zz), xy + wz, xz - wy),
346 Vec3A::new(xy - wz, 1.0 - (xx + zz), yz + wx),
347 Vec3A::new(xz + wy, yz - wx, 1.0 - (xx + yy)),
348 )
349 }
350
351 #[inline]
358 #[must_use]
359 #[cfg_attr(any(debug_assertions, feature = "glam-assert"), track_caller)]
360 pub fn from_axis_angle(axis: Vec3, angle: f32) -> Self {
361 glam_assert!(axis.is_normalized());
362
363 let (sin, cos) = math::sin_cos(angle);
364 let (xsin, ysin, zsin) = axis.mul(sin).into();
365 let (x, y, z) = axis.into();
366 let (x2, y2, z2) = axis.mul(axis).into();
367 let omc = 1.0 - cos;
368 let xyomc = x * y * omc;
369 let xzomc = x * z * omc;
370 let yzomc = y * z * omc;
371 Self::from_cols(
372 Vec3A::new(x2 * omc + cos, xyomc + zsin, xzomc - ysin),
373 Vec3A::new(xyomc - zsin, y2 * omc + cos, yzomc + xsin),
374 Vec3A::new(xzomc + ysin, yzomc - xsin, z2 * omc + cos),
375 )
376 }
377
378 #[inline]
381 #[must_use]
382 pub fn from_euler(order: EulerRot, a: f32, b: f32, c: f32) -> Self {
383 Self::from_euler_angles(order, a, b, c)
384 }
385
386 #[inline]
395 #[must_use]
396 #[cfg_attr(any(debug_assertions, feature = "glam-assert"), track_caller)]
397 pub fn to_euler(&self, order: EulerRot) -> (f32, f32, f32) {
398 glam_assert!(
399 self.x_axis.is_normalized()
400 && self.y_axis.is_normalized()
401 && self.z_axis.is_normalized()
402 );
403 self.to_euler_angles(order)
404 }
405
406 #[inline]
408 #[must_use]
409 pub fn from_rotation_x(angle: f32) -> Self {
410 let (sina, cosa) = math::sin_cos(angle);
411 Self::from_cols(
412 Vec3A::X,
413 Vec3A::new(0.0, cosa, sina),
414 Vec3A::new(0.0, -sina, cosa),
415 )
416 }
417
418 #[inline]
420 #[must_use]
421 pub fn from_rotation_y(angle: f32) -> Self {
422 let (sina, cosa) = math::sin_cos(angle);
423 Self::from_cols(
424 Vec3A::new(cosa, 0.0, -sina),
425 Vec3A::Y,
426 Vec3A::new(sina, 0.0, cosa),
427 )
428 }
429
430 #[inline]
432 #[must_use]
433 pub fn from_rotation_z(angle: f32) -> Self {
434 let (sina, cosa) = math::sin_cos(angle);
435 Self::from_cols(
436 Vec3A::new(cosa, sina, 0.0),
437 Vec3A::new(-sina, cosa, 0.0),
438 Vec3A::Z,
439 )
440 }
441
442 #[inline]
447 #[must_use]
448 pub fn from_translation(translation: Vec2) -> Self {
449 Self::from_cols(
450 Vec3A::X,
451 Vec3A::Y,
452 Vec3A::new(translation.x, translation.y, 1.0),
453 )
454 }
455
456 #[inline]
462 #[must_use]
463 pub fn from_angle(angle: f32) -> Self {
464 let (sin, cos) = math::sin_cos(angle);
465 Self::from_cols(
466 Vec3A::new(cos, sin, 0.0),
467 Vec3A::new(-sin, cos, 0.0),
468 Vec3A::Z,
469 )
470 }
471
472 #[inline]
478 #[must_use]
479 pub fn from_scale_angle_translation(scale: Vec2, angle: f32, translation: Vec2) -> Self {
480 let (sin, cos) = math::sin_cos(angle);
481 Self::from_cols(
482 Vec3A::new(cos * scale.x, sin * scale.x, 0.0),
483 Vec3A::new(-sin * scale.y, cos * scale.y, 0.0),
484 Vec3A::new(translation.x, translation.y, 1.0),
485 )
486 }
487
488 #[inline]
497 #[must_use]
498 #[cfg_attr(any(debug_assertions, feature = "glam-assert"), track_caller)]
499 pub fn from_scale(scale: Vec2) -> Self {
500 glam_assert!(scale.cmpne(Vec2::ZERO).any());
502
503 Self::from_cols(
504 Vec3A::new(scale.x, 0.0, 0.0),
505 Vec3A::new(0.0, scale.y, 0.0),
506 Vec3A::Z,
507 )
508 }
509
510 #[inline]
515 pub fn from_mat2(m: Mat2) -> Self {
516 Self::from_cols((m.x_axis, 0.0).into(), (m.y_axis, 0.0).into(), Vec3A::Z)
517 }
518
519 #[inline]
527 #[must_use]
528 #[track_caller]
529 pub const fn from_cols_slice(slice: &[f32]) -> Self {
530 Self::new(
531 slice[0], slice[1], slice[2], slice[3], slice[4], slice[5], slice[6], slice[7],
532 slice[8],
533 )
534 }
535
536 #[inline]
542 #[track_caller]
543 pub fn write_cols_to_slice(&self, slice: &mut [f32]) {
544 slice[0] = self.x_axis.x;
545 slice[1] = self.x_axis.y;
546 slice[2] = self.x_axis.z;
547 slice[3] = self.y_axis.x;
548 slice[4] = self.y_axis.y;
549 slice[5] = self.y_axis.z;
550 slice[6] = self.z_axis.x;
551 slice[7] = self.z_axis.y;
552 slice[8] = self.z_axis.z;
553 }
554
555 #[inline]
566 #[must_use]
567 #[track_caller]
568 pub const fn from_rows_slice(slice: &[f32]) -> Self {
569 Self::new(
570 slice[0], slice[3], slice[6], slice[1], slice[4], slice[7], slice[2], slice[5],
571 slice[8],
572 )
573 }
574
575 #[inline]
581 #[must_use]
582 #[track_caller]
583 pub fn col(&self, index: usize) -> Vec3A {
584 match index {
585 0 => self.x_axis,
586 1 => self.y_axis,
587 2 => self.z_axis,
588 _ => panic!("index out of bounds"),
589 }
590 }
591
592 #[inline]
598 #[track_caller]
599 pub fn col_mut(&mut self, index: usize) -> &mut Vec3A {
600 match index {
601 0 => &mut self.x_axis,
602 1 => &mut self.y_axis,
603 2 => &mut self.z_axis,
604 _ => panic!("index out of bounds"),
605 }
606 }
607
608 #[inline]
616 #[must_use]
617 #[track_caller]
618 pub fn row(&self, index: usize) -> Vec3A {
619 match index {
620 0 => Vec3A::new(self.x_axis.x, self.y_axis.x, self.z_axis.x),
621 1 => Vec3A::new(self.x_axis.y, self.y_axis.y, self.z_axis.y),
622 2 => Vec3A::new(self.x_axis.z, self.y_axis.z, self.z_axis.z),
623 _ => panic!("index out of bounds"),
624 }
625 }
626
627 #[inline]
637 #[track_caller]
638 pub fn set_row(&mut self, index: usize, row: Vec3A) {
639 match index {
640 0 => {
641 self.x_axis.x = row.x;
642 self.y_axis.x = row.y;
643 self.z_axis.x = row.z;
644 }
645 1 => {
646 self.x_axis.y = row.x;
647 self.y_axis.y = row.y;
648 self.z_axis.y = row.z;
649 }
650 2 => {
651 self.x_axis.z = row.x;
652 self.y_axis.z = row.y;
653 self.z_axis.z = row.z;
654 }
655 _ => panic!("index out of bounds"),
656 }
657 }
658
659 #[inline]
662 #[must_use]
663 pub fn is_finite(&self) -> bool {
664 self.x_axis.is_finite() && self.y_axis.is_finite() && self.z_axis.is_finite()
665 }
666
667 #[inline]
669 #[must_use]
670 pub fn is_nan(&self) -> bool {
671 self.x_axis.is_nan() || self.y_axis.is_nan() || self.z_axis.is_nan()
672 }
673
674 #[inline]
676 #[must_use]
677 pub fn transpose(&self) -> Self {
678 unsafe {
679 let tmp0 = _mm_shuffle_ps(self.x_axis.0, self.y_axis.0, 0b01_00_01_00);
680 let tmp1 = _mm_shuffle_ps(self.x_axis.0, self.y_axis.0, 0b11_10_11_10);
681
682 Self {
683 x_axis: Vec3A(_mm_shuffle_ps(tmp0, self.z_axis.0, 0b00_00_10_00)),
684 y_axis: Vec3A(_mm_shuffle_ps(tmp0, self.z_axis.0, 0b01_01_11_01)),
685 z_axis: Vec3A(_mm_shuffle_ps(tmp1, self.z_axis.0, 0b10_10_10_00)),
686 }
687 }
688 }
689
690 #[inline]
692 #[must_use]
693 pub fn diagonal(&self) -> Vec3A {
694 Vec3A::new(self.x_axis.x, self.y_axis.y, self.z_axis.z)
695 }
696
697 #[inline]
699 #[must_use]
700 pub fn determinant(&self) -> f32 {
701 self.x_axis.dot(self.y_axis.cross(self.z_axis))
702 }
703
704 #[inline(always)]
716 #[must_use]
717 #[cfg_attr(any(debug_assertions, feature = "glam-assert"), track_caller)]
718 fn inverse_checked<const CHECKED: bool>(&self) -> (Self, bool) {
719 let tmp0 = self.y_axis.cross(self.z_axis);
720 let tmp1 = self.z_axis.cross(self.x_axis);
721 let tmp2 = self.x_axis.cross(self.y_axis);
722 let inv_det = Vec3A::splat(1.0 / self.x_axis.dot(tmp0));
723 let m =
724 Self::from_cols(tmp0.mul(inv_det), tmp1.mul(inv_det), tmp2.mul(inv_det)).transpose();
725 if CHECKED {
726 if !m.is_finite() {
727 return (Self::ZERO, false);
728 }
729 } else {
730 glam_assert!(m.is_finite());
731 }
732 (m, true)
733 }
734
735 #[inline]
747 #[must_use]
748 #[cfg_attr(any(debug_assertions, feature = "glam-assert"), track_caller)]
749 pub fn inverse(&self) -> Self {
750 self.inverse_checked::<false>().0
751 }
752
753 #[inline]
756 #[must_use]
757 pub fn try_inverse(&self) -> Option<Self> {
758 let (m, is_valid) = self.inverse_checked::<true>();
759 if is_valid { Some(m) } else { None }
760 }
761
762 #[inline]
765 #[must_use]
766 pub fn inverse_or_zero(&self) -> Self {
767 self.inverse_checked::<true>().0
768 }
769
770 #[inline]
780 #[must_use]
781 #[cfg_attr(any(debug_assertions, feature = "glam-assert"), track_caller)]
782 pub fn transform_point2(&self, rhs: Vec2) -> Vec2 {
783 glam_assert!(self.row(2).abs_diff_eq(Vec3A::Z, 1e-6));
784 Mat2::from_cols(self.x_axis.xy(), self.y_axis.xy()) * rhs + self.z_axis.xy()
785 }
786
787 #[inline]
797 #[must_use]
798 #[cfg_attr(any(debug_assertions, feature = "glam-assert"), track_caller)]
799 pub fn transform_vector2(&self, rhs: Vec2) -> Vec2 {
800 glam_assert!(self.row(2).abs_diff_eq(Vec3A::Z, 1e-6));
801 Mat2::from_cols(self.x_axis.xy(), self.y_axis.xy()) * rhs
802 }
803
804 #[inline]
806 #[must_use]
807 pub fn mul_vec3(&self, rhs: Vec3) -> Vec3 {
808 self.mul_vec3a(rhs.into()).into()
809 }
810
811 #[inline]
813 #[must_use]
814 pub fn mul_vec3a(&self, rhs: Vec3A) -> Vec3A {
815 let mut res = self.x_axis.mul(rhs.xxx());
816 res = res.add(self.y_axis.mul(rhs.yyy()));
817 res = res.add(self.z_axis.mul(rhs.zzz()));
818 res
819 }
820
821 #[inline]
823 #[must_use]
824 pub fn mul_transpose_vec3(&self, rhs: Vec3) -> Vec3 {
825 self.mul_transpose_vec3a(rhs.into()).into()
826 }
827
828 #[inline]
830 #[must_use]
831 pub fn mul_transpose_vec3a(&self, rhs: Vec3A) -> Vec3A {
832 Vec3A::new(
833 self.x_axis.dot(rhs),
834 self.y_axis.dot(rhs),
835 self.z_axis.dot(rhs),
836 )
837 }
838
839 #[inline]
841 #[must_use]
842 pub fn mul_mat3(&self, rhs: &Self) -> Self {
843 self.mul(rhs)
844 }
845
846 #[inline]
848 #[must_use]
849 pub fn add_mat3(&self, rhs: &Self) -> Self {
850 self.add(rhs)
851 }
852
853 #[inline]
855 #[must_use]
856 pub fn sub_mat3(&self, rhs: &Self) -> Self {
857 self.sub(rhs)
858 }
859
860 #[inline]
862 #[must_use]
863 pub fn mul_scalar(&self, rhs: f32) -> Self {
864 Self::from_cols(
865 self.x_axis.mul(rhs),
866 self.y_axis.mul(rhs),
867 self.z_axis.mul(rhs),
868 )
869 }
870
871 #[inline]
875 #[must_use]
876 pub fn mul_diagonal_scale(&self, scale: Vec3) -> Self {
877 Self::from_cols(
878 self.x_axis * scale.x,
879 self.y_axis * scale.y,
880 self.z_axis * scale.z,
881 )
882 }
883
884 #[inline]
886 #[must_use]
887 pub fn div_scalar(&self, rhs: f32) -> Self {
888 let rhs = Vec3A::splat(rhs);
889 Self::from_cols(
890 self.x_axis.div(rhs),
891 self.y_axis.div(rhs),
892 self.z_axis.div(rhs),
893 )
894 }
895
896 #[inline]
898 #[must_use]
899 pub fn recip(&self) -> Self {
900 Self::from_cols(
901 self.x_axis.recip(),
902 self.y_axis.recip(),
903 self.z_axis.recip(),
904 )
905 }
906
907 #[inline]
917 #[must_use]
918 pub fn abs_diff_eq(&self, rhs: Self, max_abs_diff: f32) -> bool {
919 self.x_axis.abs_diff_eq(rhs.x_axis, max_abs_diff)
920 && self.y_axis.abs_diff_eq(rhs.y_axis, max_abs_diff)
921 && self.z_axis.abs_diff_eq(rhs.z_axis, max_abs_diff)
922 }
923
924 #[inline]
926 #[must_use]
927 pub fn abs(&self) -> Self {
928 Self::from_cols(self.x_axis.abs(), self.y_axis.abs(), self.z_axis.abs())
929 }
930
931 #[cfg(feature = "f64")]
932 #[inline]
933 #[must_use]
934 pub fn as_dmat3(&self) -> DMat3 {
935 DMat3::from_cols(
936 self.x_axis.as_dvec3(),
937 self.y_axis.as_dvec3(),
938 self.z_axis.as_dvec3(),
939 )
940 }
941}
942
943impl Default for Mat3A {
944 #[inline]
945 fn default() -> Self {
946 Self::IDENTITY
947 }
948}
949
950impl Add for Mat3A {
951 type Output = Self;
952 #[inline]
953 fn add(self, rhs: Self) -> Self {
954 Self::from_cols(
955 self.x_axis.add(rhs.x_axis),
956 self.y_axis.add(rhs.y_axis),
957 self.z_axis.add(rhs.z_axis),
958 )
959 }
960}
961
962impl Add<&Self> for Mat3A {
963 type Output = Self;
964 #[inline]
965 fn add(self, rhs: &Self) -> Self {
966 self.add(*rhs)
967 }
968}
969
970impl Add<&Mat3A> for &Mat3A {
971 type Output = Mat3A;
972 #[inline]
973 fn add(self, rhs: &Mat3A) -> Mat3A {
974 (*self).add(*rhs)
975 }
976}
977
978impl Add<Mat3A> for &Mat3A {
979 type Output = Mat3A;
980 #[inline]
981 fn add(self, rhs: Mat3A) -> Mat3A {
982 (*self).add(rhs)
983 }
984}
985
986impl AddAssign for Mat3A {
987 #[inline]
988 fn add_assign(&mut self, rhs: Self) {
989 *self = self.add(rhs);
990 }
991}
992
993impl AddAssign<&Self> for Mat3A {
994 #[inline]
995 fn add_assign(&mut self, rhs: &Self) {
996 self.add_assign(*rhs);
997 }
998}
999
1000impl Sub for Mat3A {
1001 type Output = Self;
1002 #[inline]
1003 fn sub(self, rhs: Self) -> Self {
1004 Self::from_cols(
1005 self.x_axis.sub(rhs.x_axis),
1006 self.y_axis.sub(rhs.y_axis),
1007 self.z_axis.sub(rhs.z_axis),
1008 )
1009 }
1010}
1011
1012impl Sub<&Self> for Mat3A {
1013 type Output = Self;
1014 #[inline]
1015 fn sub(self, rhs: &Self) -> Self {
1016 self.sub(*rhs)
1017 }
1018}
1019
1020impl Sub<&Mat3A> for &Mat3A {
1021 type Output = Mat3A;
1022 #[inline]
1023 fn sub(self, rhs: &Mat3A) -> Mat3A {
1024 (*self).sub(*rhs)
1025 }
1026}
1027
1028impl Sub<Mat3A> for &Mat3A {
1029 type Output = Mat3A;
1030 #[inline]
1031 fn sub(self, rhs: Mat3A) -> Mat3A {
1032 (*self).sub(rhs)
1033 }
1034}
1035
1036impl SubAssign for Mat3A {
1037 #[inline]
1038 fn sub_assign(&mut self, rhs: Self) {
1039 *self = self.sub(rhs);
1040 }
1041}
1042
1043impl SubAssign<&Self> for Mat3A {
1044 #[inline]
1045 fn sub_assign(&mut self, rhs: &Self) {
1046 self.sub_assign(*rhs);
1047 }
1048}
1049
1050impl Neg for Mat3A {
1051 type Output = Self;
1052 #[inline]
1053 fn neg(self) -> Self::Output {
1054 Self::from_cols(self.x_axis.neg(), self.y_axis.neg(), self.z_axis.neg())
1055 }
1056}
1057
1058impl Neg for &Mat3A {
1059 type Output = Mat3A;
1060 #[inline]
1061 fn neg(self) -> Mat3A {
1062 (*self).neg()
1063 }
1064}
1065
1066impl Mul for Mat3A {
1067 type Output = Self;
1068 #[inline]
1069 fn mul(self, rhs: Self) -> Self {
1070 Self::from_cols(
1071 self.mul(rhs.x_axis),
1072 self.mul(rhs.y_axis),
1073 self.mul(rhs.z_axis),
1074 )
1075 }
1076}
1077
1078impl Mul<&Self> for Mat3A {
1079 type Output = Self;
1080 #[inline]
1081 fn mul(self, rhs: &Self) -> Self {
1082 self.mul(*rhs)
1083 }
1084}
1085
1086impl Mul<&Mat3A> for &Mat3A {
1087 type Output = Mat3A;
1088 #[inline]
1089 fn mul(self, rhs: &Mat3A) -> Mat3A {
1090 (*self).mul(*rhs)
1091 }
1092}
1093
1094impl Mul<Mat3A> for &Mat3A {
1095 type Output = Mat3A;
1096 #[inline]
1097 fn mul(self, rhs: Mat3A) -> Mat3A {
1098 (*self).mul(rhs)
1099 }
1100}
1101
1102impl MulAssign for Mat3A {
1103 #[inline]
1104 fn mul_assign(&mut self, rhs: Self) {
1105 *self = self.mul(rhs);
1106 }
1107}
1108
1109impl MulAssign<&Self> for Mat3A {
1110 #[inline]
1111 fn mul_assign(&mut self, rhs: &Self) {
1112 self.mul_assign(*rhs);
1113 }
1114}
1115
1116impl Mul<Vec3A> for Mat3A {
1117 type Output = Vec3A;
1118 #[inline]
1119 fn mul(self, rhs: Vec3A) -> Self::Output {
1120 self.mul_vec3a(rhs)
1121 }
1122}
1123
1124impl Mul<&Vec3A> for Mat3A {
1125 type Output = Vec3A;
1126 #[inline]
1127 fn mul(self, rhs: &Vec3A) -> Vec3A {
1128 self.mul(*rhs)
1129 }
1130}
1131
1132impl Mul<&Vec3A> for &Mat3A {
1133 type Output = Vec3A;
1134 #[inline]
1135 fn mul(self, rhs: &Vec3A) -> Vec3A {
1136 (*self).mul(*rhs)
1137 }
1138}
1139
1140impl Mul<Vec3A> for &Mat3A {
1141 type Output = Vec3A;
1142 #[inline]
1143 fn mul(self, rhs: Vec3A) -> Vec3A {
1144 (*self).mul(rhs)
1145 }
1146}
1147
1148impl Mul<Mat3A> for f32 {
1149 type Output = Mat3A;
1150 #[inline]
1151 fn mul(self, rhs: Mat3A) -> Self::Output {
1152 rhs.mul_scalar(self)
1153 }
1154}
1155
1156impl Mul<&Mat3A> for f32 {
1157 type Output = Mat3A;
1158 #[inline]
1159 fn mul(self, rhs: &Mat3A) -> Mat3A {
1160 self.mul(*rhs)
1161 }
1162}
1163
1164impl Mul<&Mat3A> for &f32 {
1165 type Output = Mat3A;
1166 #[inline]
1167 fn mul(self, rhs: &Mat3A) -> Mat3A {
1168 (*self).mul(*rhs)
1169 }
1170}
1171
1172impl Mul<Mat3A> for &f32 {
1173 type Output = Mat3A;
1174 #[inline]
1175 fn mul(self, rhs: Mat3A) -> Mat3A {
1176 (*self).mul(rhs)
1177 }
1178}
1179
1180impl Mul<f32> for Mat3A {
1181 type Output = Self;
1182 #[inline]
1183 fn mul(self, rhs: f32) -> Self {
1184 self.mul_scalar(rhs)
1185 }
1186}
1187
1188impl Mul<&f32> for Mat3A {
1189 type Output = Self;
1190 #[inline]
1191 fn mul(self, rhs: &f32) -> Self {
1192 self.mul(*rhs)
1193 }
1194}
1195
1196impl Mul<&f32> for &Mat3A {
1197 type Output = Mat3A;
1198 #[inline]
1199 fn mul(self, rhs: &f32) -> Mat3A {
1200 (*self).mul(*rhs)
1201 }
1202}
1203
1204impl Mul<f32> for &Mat3A {
1205 type Output = Mat3A;
1206 #[inline]
1207 fn mul(self, rhs: f32) -> Mat3A {
1208 (*self).mul(rhs)
1209 }
1210}
1211
1212impl MulAssign<f32> for Mat3A {
1213 #[inline]
1214 fn mul_assign(&mut self, rhs: f32) {
1215 *self = self.mul(rhs);
1216 }
1217}
1218
1219impl MulAssign<&f32> for Mat3A {
1220 #[inline]
1221 fn mul_assign(&mut self, rhs: &f32) {
1222 self.mul_assign(*rhs);
1223 }
1224}
1225
1226impl Div<Mat3A> for f32 {
1227 type Output = Mat3A;
1228 #[inline]
1229 fn div(self, rhs: Mat3A) -> Self::Output {
1230 Mat3A::from_cols(
1231 self.div(rhs.x_axis),
1232 self.div(rhs.y_axis),
1233 self.div(rhs.z_axis),
1234 )
1235 }
1236}
1237
1238impl Div<&Mat3A> for f32 {
1239 type Output = Mat3A;
1240 #[inline]
1241 fn div(self, rhs: &Mat3A) -> Mat3A {
1242 self.div(*rhs)
1243 }
1244}
1245
1246impl Div<&Mat3A> for &f32 {
1247 type Output = Mat3A;
1248 #[inline]
1249 fn div(self, rhs: &Mat3A) -> Mat3A {
1250 (*self).div(*rhs)
1251 }
1252}
1253
1254impl Div<Mat3A> for &f32 {
1255 type Output = Mat3A;
1256 #[inline]
1257 fn div(self, rhs: Mat3A) -> Mat3A {
1258 (*self).div(rhs)
1259 }
1260}
1261
1262impl Div<f32> for Mat3A {
1263 type Output = Self;
1264 #[inline]
1265 fn div(self, rhs: f32) -> Self {
1266 self.div_scalar(rhs)
1267 }
1268}
1269
1270impl Div<&f32> for Mat3A {
1271 type Output = Self;
1272 #[inline]
1273 fn div(self, rhs: &f32) -> Self {
1274 self.div(*rhs)
1275 }
1276}
1277
1278impl Div<&f32> for &Mat3A {
1279 type Output = Mat3A;
1280 #[inline]
1281 fn div(self, rhs: &f32) -> Mat3A {
1282 (*self).div(*rhs)
1283 }
1284}
1285
1286impl Div<f32> for &Mat3A {
1287 type Output = Mat3A;
1288 #[inline]
1289 fn div(self, rhs: f32) -> Mat3A {
1290 (*self).div(rhs)
1291 }
1292}
1293
1294impl DivAssign<f32> for Mat3A {
1295 #[inline]
1296 fn div_assign(&mut self, rhs: f32) {
1297 *self = self.div(rhs);
1298 }
1299}
1300
1301impl DivAssign<&f32> for Mat3A {
1302 #[inline]
1303 fn div_assign(&mut self, rhs: &f32) {
1304 self.div_assign(*rhs);
1305 }
1306}
1307
1308impl Mul<Vec3> for Mat3A {
1309 type Output = Vec3;
1310 #[inline]
1311 fn mul(self, rhs: Vec3) -> Vec3 {
1312 self.mul_vec3a(rhs.into()).into()
1313 }
1314}
1315
1316impl Mul<&Vec3> for Mat3A {
1317 type Output = Vec3;
1318 #[inline]
1319 fn mul(self, rhs: &Vec3) -> Vec3 {
1320 self.mul(*rhs)
1321 }
1322}
1323
1324impl Mul<&Vec3> for &Mat3A {
1325 type Output = Vec3;
1326 #[inline]
1327 fn mul(self, rhs: &Vec3) -> Vec3 {
1328 (*self).mul(*rhs)
1329 }
1330}
1331
1332impl Mul<Vec3> for &Mat3A {
1333 type Output = Vec3;
1334 #[inline]
1335 fn mul(self, rhs: Vec3) -> Vec3 {
1336 (*self).mul(rhs)
1337 }
1338}
1339
1340impl From<Mat3> for Mat3A {
1341 #[inline]
1342 fn from(m: Mat3) -> Self {
1343 Self {
1344 x_axis: m.x_axis.into(),
1345 y_axis: m.y_axis.into(),
1346 z_axis: m.z_axis.into(),
1347 }
1348 }
1349}
1350
1351impl Sum<Self> for Mat3A {
1352 fn sum<I>(iter: I) -> Self
1353 where
1354 I: Iterator<Item = Self>,
1355 {
1356 iter.fold(Self::ZERO, Self::add)
1357 }
1358}
1359
1360impl<'a> Sum<&'a Self> for Mat3A {
1361 fn sum<I>(iter: I) -> Self
1362 where
1363 I: Iterator<Item = &'a Self>,
1364 {
1365 iter.fold(Self::ZERO, |a, &b| Self::add(a, b))
1366 }
1367}
1368
1369impl Product for Mat3A {
1370 fn product<I>(iter: I) -> Self
1371 where
1372 I: Iterator<Item = Self>,
1373 {
1374 iter.fold(Self::IDENTITY, Self::mul)
1375 }
1376}
1377
1378impl<'a> Product<&'a Self> for Mat3A {
1379 fn product<I>(iter: I) -> Self
1380 where
1381 I: Iterator<Item = &'a Self>,
1382 {
1383 iter.fold(Self::IDENTITY, |a, &b| Self::mul(a, b))
1384 }
1385}
1386
1387impl PartialEq for Mat3A {
1388 #[inline]
1389 fn eq(&self, rhs: &Self) -> bool {
1390 self.x_axis.eq(&rhs.x_axis) && self.y_axis.eq(&rhs.y_axis) && self.z_axis.eq(&rhs.z_axis)
1391 }
1392}
1393
1394impl fmt::Debug for Mat3A {
1395 fn fmt(&self, fmt: &mut fmt::Formatter<'_>) -> fmt::Result {
1396 fmt.debug_struct(stringify!(Mat3A))
1397 .field("x_axis", &self.x_axis)
1398 .field("y_axis", &self.y_axis)
1399 .field("z_axis", &self.z_axis)
1400 .finish()
1401 }
1402}
1403
1404impl fmt::Display for Mat3A {
1405 fn fmt(&self, f: &mut fmt::Formatter<'_>) -> fmt::Result {
1406 if let Some(p) = f.precision() {
1407 write!(
1408 f,
1409 "[{:.*}, {:.*}, {:.*}]",
1410 p, self.x_axis, p, self.y_axis, p, self.z_axis
1411 )
1412 } else {
1413 write!(f, "[{}, {}, {}]", self.x_axis, self.y_axis, self.z_axis)
1414 }
1415 }
1416}