// Copyright 2013 The Lmath Developers. For a full listing of the authors, // refer to the AUTHORS file at the top-level directory of this distribution. // // Licensed under the Apache License, Version 2.0 (the "License"); // you may not use this file except in compliance with the License. // You may obtain a copy of the License at // // http://www.apache.org/licenses/LICENSE-2.0 // // Unless required by applicable law or agreed to in writing, software // distributed under the License is distributed on an "AS IS" BASIS, // WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. // See the License for the specific language governing permissions and // limitations under the License. use mat::*; use vec::*; // TODO #[test] fn test_mat2() { let a = Mat2 { x: Vec2 { x: 1.0, y: 3.0 }, y: Vec2 { x: 2.0, y: 4.0 } }; let b = Mat2 { x: Vec2 { x: 2.0, y: 4.0 }, y: Vec2 { x: 3.0, y: 5.0 } }; let v1 = vec2::new(1.0, 2.0); let f1 = 0.5; assert_eq!(a, mat2::new(1.0, 3.0, 2.0, 4.0)); assert_eq!(a, mat2::from_cols(vec2::new(1.0, 3.0), vec2::new(2.0, 4.0))); assert_eq!(mat2::from_value(4.0), mat2::new(4.0, 0.0, 0.0, 4.0)); assert_eq!(*a.col(0), vec2::new(1.0, 3.0)); assert_eq!(*a.col(1), vec2::new(2.0, 4.0)); assert_eq!(a.row(0), vec2::new(1.0, 2.0)); assert_eq!(a.row(1), vec2::new(3.0, 4.0)); assert_eq!(*a.col(0), vec2::new(1.0, 3.0)); assert_eq!(*a.col(1), vec2::new(2.0, 4.0)); assert_eq!(mat2::identity(), mat2::new(1.0, 0.0, 0.0, 1.0)); assert_eq!(mat2::zero(), mat2::new(0.0, 0.0, 0.0, 0.0)); assert_eq!(a.determinant(), -2.0); assert_eq!(a.trace(), 5.0); assert_eq!(a.neg(), mat2::new(-1.0, -3.0, -2.0, -4.0)); assert_eq!(-a, a.neg()); assert_eq!(a.mul_t(f1), mat2::new(0.5, 1.5, 1.0, 2.0)); assert_eq!(a.mul_v(&v1), vec2::new(5.0, 11.0)); assert_eq!(a.add_m(&b), mat2::new(3.0, 7.0, 5.0, 9.0)); assert_eq!(a.sub_m(&b), mat2::new(-1.0, -1.0, -1.0, -1.0)); assert_eq!(a.mul_m(&b), mat2::new(10.0, 22.0, 13.0, 29.0)); assert_eq!(a.dot(&b), 40.0); assert_eq!(a.transpose(), mat2::new(1.0, 2.0, 3.0, 4.0)); assert_eq!(a.inverse().unwrap(), mat2::new(-2.0, 1.5, 1.0, -0.5)); assert!(mat2::new(0.0, 2.0, 0.0, 5.0).inverse().is_none()); let ident = mat2::identity(); assert!(ident.is_identity()); assert!(ident.is_symmetric()); assert!(ident.is_diagonal()); assert!(!ident.is_rotated()); assert!(ident.is_invertible()); assert!(!a.is_identity()); assert!(!a.is_symmetric()); assert!(!a.is_diagonal()); assert!(a.is_rotated()); assert!(a.is_invertible()); let c = mat2::new(2.0, 1.0, 1.0, 2.0); assert!(!c.is_identity()); assert!(c.is_symmetric()); assert!(!c.is_diagonal()); assert!(c.is_rotated()); assert!(c.is_invertible()); assert!(mat2::from_value(6.0).is_diagonal()); assert_eq!(a.to_mat3(), mat3::new(1.0, 3.0, 0.0, 2.0, 4.0, 0.0, 0.0, 0.0, 1.0)); assert_eq!(a.to_mat4(), mat4::new(1.0, 3.0, 0.0, 0.0, 2.0, 4.0, 0.0, 0.0, 0.0, 0.0, 1.0, 0.0, 0.0, 0.0, 0.0, 1.0)); } fn test_mat2_mut() { let a = Mat2 { x: Vec2 { x: 1.0, y: 3.0 }, y: Vec2 { x: 2.0, y: 4.0 } }; let b = Mat2 { x: Vec2 { x: 2.0, y: 4.0 }, y: Vec2 { x: 3.0, y: 5.0 } }; let f1 = 0.5; let mut mut_a: mat2 = a; mut_a.swap_cols(0, 1); assert_eq!(mut_a.col(0), a.col(1)); assert_eq!(mut_a.col(1), a.col(0)); mut_a = a; mut_a.swap_rows(0, 1); assert_eq!(mut_a.row(0), a.row(1)); assert_eq!(mut_a.row(1), a.row(0)); mut_a = a; mut_a.set(&b); assert_eq!(mut_a, b); mut_a = a; mut_a.to_identity(); assert!(mut_a.is_identity()); mut_a = a; mut_a.to_zero(); assert_eq!(mut_a, mat2::zero()); mut_a = a; mut_a.mul_self_t(f1); assert_eq!(mut_a, a.mul_t(f1)); mut_a = a; mut_a.add_self_m(&b); assert_eq!(mut_a, a.add_m(&b)); mut_a = a; mut_a.sub_self_m(&b); assert_eq!(mut_a, a.sub_m(&b)); mut_a = a; mut_a.invert_self(); assert_eq!(mut_a, a.inverse().unwrap()); mut_a = a; mut_a.transpose_self(); assert_eq!(mut_a, a.transpose()); // mut_a = a; } #[test] fn test_mat2_approx_eq() { assert!(!mat2::new(0.000001, 0.000001, 0.000001, 0.000001).approx_eq(&mat2::zero())); assert!(mat2::new(0.0000001, 0.0000001, 0.0000001, 0.0000001).approx_eq(&mat2::zero())); } #[test] fn test_mat3() { let a = Mat3 { x: Vec3 { x: 1.0, y: 4.0, z: 7.0 }, y: Vec3 { x: 2.0, y: 5.0, z: 8.0 }, z: Vec3 { x: 3.0, y: 6.0, z: 9.0 } }; let b = Mat3 { x: Vec3 { x: 2.0, y: 5.0, z: 8.0 }, y: Vec3 { x: 3.0, y: 6.0, z: 9.0 }, z: Vec3 { x: 4.0, y: 7.0, z: 10.0 } }; let v1 = vec3::new(1.0, 2.0, 3.0); let f1 = 0.5; assert_eq!(a, mat3::new(1.0, 4.0, 7.0, 2.0, 5.0, 8.0, 3.0, 6.0, 9.0)); assert_eq!(a, mat3::from_cols(vec3::new(1.0, 4.0, 7.0), vec3::new(2.0, 5.0, 8.0), vec3::new(3.0, 6.0, 9.0))); assert_eq!(*a.col(0), vec3::new(1.0, 4.0, 7.0)); assert_eq!(*a.col(1), vec3::new(2.0, 5.0, 8.0)); assert_eq!(*a.col(2), vec3::new(3.0, 6.0, 9.0)); assert_eq!(a.row(0), vec3::new(1.0, 2.0, 3.0)); assert_eq!(a.row(1), vec3::new(4.0, 5.0, 6.0)); assert_eq!(a.row(2), vec3::new(7.0, 8.0, 9.0)); assert_eq!(*a.col(0), vec3::new(1.0, 4.0, 7.0)); assert_eq!(*a.col(1), vec3::new(2.0, 5.0, 8.0)); assert_eq!(*a.col(2), vec3::new(3.0, 6.0, 9.0)); assert_eq!(mat3::identity(), mat3::new(1.0, 0.0, 0.0, 0.0, 1.0, 0.0, 0.0, 0.0, 1.0)); assert_eq!(mat3::zero(), mat3::new(0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0)); assert_eq!(a.determinant(), 0.0); assert_eq!(a.trace(), 15.0); assert_eq!(a.neg(), mat3::new(-1.0, -4.0, -7.0, -2.0, -5.0, -8.0, -3.0, -6.0, -9.0)); assert_eq!(-a, a.neg()); assert_eq!(a.mul_t(f1), mat3::new(0.5, 2.0, 3.5, 1.0, 2.5, 4.0, 1.5, 3.0, 4.5)); assert_eq!(a.mul_v(&v1), vec3::new(14.0, 32.0, 50.0)); assert_eq!(a.add_m(&b), mat3::new(3.0, 9.0, 15.0, 5.0, 11.0, 17.0, 7.0, 13.0, 19.0)); assert_eq!(a.sub_m(&b), mat3::new(-1.0, -1.0, -1.0, -1.0, -1.0, -1.0, -1.0, -1.0, -1.0)); assert_eq!(a.mul_m(&b), mat3::new(36.0, 81.0, 126.0, 42.0, 96.0, 150.0, 48.0, 111.0, 174.0)); assert_eq!(a.dot(&b), 330.0); assert_eq!(a.transpose(), mat3::new(1.0, 2.0, 3.0, 4.0, 5.0, 6.0, 7.0, 8.0, 9.0)); assert!(a.inverse().is_none()); assert_eq!(mat3::new(2.0, 4.0, 6.0, 0.0, 2.0, 4.0, 0.0, 0.0, 1.0).inverse().unwrap(), mat3::new(0.5, -1.0, 1.0, 0.0, 0.5, -2.0, 0.0, 0.0, 1.0)); let ident: Mat3 = BaseMat::identity(); assert_eq!(ident.inverse().unwrap(), ident); assert!(ident.is_identity()); assert!(ident.is_symmetric()); assert!(ident.is_diagonal()); assert!(!ident.is_rotated()); assert!(ident.is_invertible()); assert!(!a.is_identity()); assert!(!a.is_symmetric()); assert!(!a.is_diagonal()); assert!(a.is_rotated()); assert!(!a.is_invertible()); let c = mat3::new(3.0, 2.0, 1.0, 2.0, 3.0, 2.0, 1.0, 2.0, 3.0); assert!(!c.is_identity()); assert!(c.is_symmetric()); assert!(!c.is_diagonal()); assert!(c.is_rotated()); assert!(c.is_invertible()); assert!(mat3::from_value(6.0).is_diagonal()); assert_eq!(a.to_mat4(), mat4::new(1.0, 4.0, 7.0, 0.0, 2.0, 5.0, 8.0, 0.0, 3.0, 6.0, 9.0, 0.0, 0.0, 0.0, 0.0, 1.0)); // to_Quaternion } fn test_mat3_mut() { let a = Mat3 { x: Vec3 { x: 1.0, y: 4.0, z: 7.0 }, y: Vec3 { x: 2.0, y: 5.0, z: 8.0 }, z: Vec3 { x: 3.0, y: 6.0, z: 9.0 } }; let b = Mat3 { x: Vec3 { x: 2.0, y: 5.0, z: 8.0 }, y: Vec3 { x: 3.0, y: 6.0, z: 9.0 }, z: Vec3 { x: 4.0, y: 7.0, z: 10.0 } }; let c = Mat3 { x: Vec3 { x: 2.0, y: 4.0, z: 6.0 }, y: Vec3 { x: 0.0, y: 2.0, z: 4.0 }, z: Vec3 { x: 0.0, y: 0.0, z: 1.0 } }; let f1 = 0.5; let mut mut_a: mat3 = a; let mut mut_c: mat3 = c; mut_a.swap_cols(0, 2); assert_eq!(mut_a.col(0), a.col(2)); assert_eq!(mut_a.col(2), a.col(0)); mut_a = a; mut_a.swap_cols(1, 2); assert_eq!(mut_a.col(1), a.col(2)); assert_eq!(mut_a.col(2), a.col(1)); mut_a = a; mut_a.swap_rows(0, 2); assert_eq!(mut_a.row(0), a.row(2)); assert_eq!(mut_a.row(2), a.row(0)); mut_a = a; mut_a.swap_rows(1, 2); assert_eq!(mut_a.row(1), a.row(2)); assert_eq!(mut_a.row(2), a.row(1)); mut_a = a; mut_a.set(&b); assert_eq!(mut_a, b); mut_a = a; mut_a.to_identity(); assert!(mut_a.is_identity()); mut_a = a; mut_a.to_zero(); assert_eq!(mut_a, mat3::zero()); mut_a = a; mut_a.mul_self_t(f1); assert_eq!(mut_a, a.mul_t(f1)); mut_a = a; mut_a.add_self_m(&b); assert_eq!(mut_a, a.add_m(&b)); mut_a = a; mut_a.sub_self_m(&b); assert_eq!(mut_a, a.sub_m(&b)); mut_a = a; mut_c.invert_self(); assert_eq!(mut_c, c.inverse().unwrap()); // mut_c = c; mut_a.transpose_self(); assert_eq!(mut_a, a.transpose()); // mut_a = a; } #[test] fn test_mat3_approx_eq() { assert!(!mat3::new(0.000001, 0.000001, 0.000001, 0.000001, 0.000001, 0.000001, 0.000001, 0.000001, 0.000001).approx_eq(&mat3::zero())); assert!(mat3::new(0.0000001, 0.0000001, 0.0000001, 0.0000001, 0.0000001, 0.0000001, 0.0000001, 0.0000001, 0.0000001).approx_eq(&mat3::zero())); } #[test] fn test_mat4() { let a: mat4 = Mat4 { x: Vec4 { x: 1.0, y: 5.0, z: 9.0, w: 13.0 }, y: Vec4 { x: 2.0, y: 6.0, z: 10.0, w: 14.0 }, z: Vec4 { x: 3.0, y: 7.0, z: 11.0, w: 15.0 }, w: Vec4 { x: 4.0, y: 8.0, z: 12.0, w: 16.0 } }; let b: mat4 = Mat4 { x: Vec4 { x: 2.0, y: 6.0, z: 10.0, w: 14.0 }, y: Vec4 { x: 3.0, y: 7.0, z: 11.0, w: 15.0 }, z: Vec4 { x: 4.0, y: 8.0, z: 12.0, w: 16.0 }, w: Vec4 { x: 5.0, y: 9.0, z: 13.0, w: 17.0 } }; let c: mat4 = Mat4 { x: Vec4 { x: 3.0, y: 2.0, z: 1.0, w: 1.0 }, y: Vec4 { x: 2.0, y: 3.0, z: 2.0, w: 2.0 }, z: Vec4 { x: 1.0, y: 2.0, z: 3.0, w: 3.0 }, w: Vec4 { x: 0.0, y: 1.0, z: 1.0, w: 0.0 } }; let v1 = vec4::new(1.0, 2.0, 3.0, 4.0); let f1 = 0.5; assert_eq!(a, mat4::new(1.0, 5.0, 9.0, 13.0, 2.0, 6.0, 10.0, 14.0, 3.0, 7.0, 11.0, 15.0, 4.0, 8.0, 12.0, 16.0)); assert_eq!(a, mat4::from_cols(vec4::new(1.0, 5.0, 9.0, 13.0), vec4::new(2.0, 6.0, 10.0, 14.0), vec4::new(3.0, 7.0, 11.0, 15.0), vec4::new(4.0, 8.0, 12.0, 16.0))); assert_eq!(mat4::from_value(4.0), mat4::new(4.0, 0.0, 0.0, 0.0, 0.0, 4.0, 0.0, 0.0, 0.0, 0.0, 4.0, 0.0, 0.0, 0.0, 0.0, 4.0)); assert_eq!(*a.col(0), vec4::new(1.0, 5.0, 9.0, 13.0)); assert_eq!(*a.col(1), vec4::new(2.0, 6.0, 10.0, 14.0)); assert_eq!(*a.col(2), vec4::new(3.0, 7.0, 11.0, 15.0)); assert_eq!(*a.col(3), vec4::new(4.0, 8.0, 12.0, 16.0)); assert_eq!(a.row(0), vec4::new( 1.0, 2.0, 3.0, 4.0)); assert_eq!(a.row(1), vec4::new( 5.0, 6.0, 7.0, 8.0)); assert_eq!(a.row(2), vec4::new( 9.0, 10.0, 11.0, 12.0)); assert_eq!(a.row(3), vec4::new(13.0, 14.0, 15.0, 16.0)); assert_eq!(*a.col(0), vec4::new(1.0, 5.0, 9.0, 13.0)); assert_eq!(*a.col(1), vec4::new(2.0, 6.0, 10.0, 14.0)); assert_eq!(*a.col(2), vec4::new(3.0, 7.0, 11.0, 15.0)); assert_eq!(*a.col(3), vec4::new(4.0, 8.0, 12.0, 16.0)); assert_eq!(mat4::identity(), mat4::new(1.0, 0.0, 0.0, 0.0, 0.0, 1.0, 0.0, 0.0, 0.0, 0.0, 1.0, 0.0, 0.0, 0.0, 0.0, 1.0)); assert_eq!(mat4::zero(), mat4::new(0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0)); assert_eq!(a.determinant(), 0.0); assert_eq!(a.trace(), 34.0); assert_eq!(a.neg(), mat4::new(-1.0, -5.0, -9.0, -13.0, -2.0, -6.0, -10.0, -14.0, -3.0, -7.0, -11.0, -15.0, -4.0, -8.0, -12.0, -16.0)); assert_eq!(-a, a.neg()); assert_eq!(a.mul_t(f1), mat4::new(0.5, 2.5, 4.5, 6.5, 1.0, 3.0, 5.0, 7.0, 1.5, 3.5, 5.5, 7.5, 2.0, 4.0, 6.0, 8.0)); assert_eq!(a.mul_v(&v1), vec4::new(30.0, 70.0, 110.0, 150.0)); assert_eq!(a.add_m(&b), mat4::new(3.0, 11.0, 19.0, 27.0, 5.0, 13.0, 21.0, 29.0, 7.0, 15.0, 23.0, 31.0, 9.0, 17.0, 25.0, 33.0)); assert_eq!(a.sub_m(&b), mat4::new(-1.0, -1.0, -1.0, -1.0, -1.0, -1.0, -1.0, -1.0, -1.0, -1.0, -1.0, -1.0, -1.0, -1.0, -1.0, -1.0)); assert_eq!(a.mul_m(&b), mat4::new(100.0, 228.0, 356.0, 484.0, 110.0, 254.0, 398.0, 542.0, 120.0, 280.0, 440.0, 600.0, 130.0, 306.0, 482.0, 658.0)); assert_eq!(a.dot(&b), 1632.0); assert_eq!(a.transpose(), mat4::new( 1.0, 2.0, 3.0, 4.0, 5.0, 6.0, 7.0, 8.0, 9.0, 10.0, 11.0, 12.0, 13.0, 14.0, 15.0, 16.0)); assert!(c.inverse().unwrap().approx_eq( &mat4::new( 5.0, -4.0, 1.0, 0.0, -4.0, 8.0, -4.0, 0.0, 4.0, -8.0, 4.0, 8.0, -3.0, 4.0, 1.0, -8.0).mul_t(0.125)) ); let ident = mat4::identity(); assert_eq!(ident.inverse().unwrap(), ident); assert!(ident.is_identity()); assert!(ident.is_symmetric()); assert!(ident.is_diagonal()); assert!(!ident.is_rotated()); assert!(ident.is_invertible()); assert!(!a.is_identity()); assert!(!a.is_symmetric()); assert!(!a.is_diagonal()); assert!(a.is_rotated()); assert!(!a.is_invertible()); let c = mat4::new(4.0, 3.0, 2.0, 1.0, 3.0, 4.0, 3.0, 2.0, 2.0, 3.0, 4.0, 3.0, 1.0, 2.0, 3.0, 4.0); assert!(!c.is_identity()); assert!(c.is_symmetric()); assert!(!c.is_diagonal()); assert!(c.is_rotated()); assert!(c.is_invertible()); assert!(mat4::from_value(6.0).is_diagonal()); } fn test_mat4_mut() { let a = Mat4 { x: Vec4 { x: 1.0, y: 5.0, z: 9.0, w: 13.0 }, y: Vec4 { x: 2.0, y: 6.0, z: 10.0, w: 14.0 }, z: Vec4 { x: 3.0, y: 7.0, z: 11.0, w: 15.0 }, w: Vec4 { x: 4.0, y: 8.0, z: 12.0, w: 16.0 } }; let b = Mat4 { x: Vec4 { x: 2.0, y: 6.0, z: 10.0, w: 14.0 }, y: Vec4 { x: 3.0, y: 7.0, z: 11.0, w: 15.0 }, z: Vec4 { x: 4.0, y: 8.0, z: 12.0, w: 16.0 }, w: Vec4 { x: 5.0, y: 9.0, z: 13.0, w: 17.0 } }; let c = Mat4 { x: Vec4 { x: 3.0, y: 2.0, z: 1.0, w: 1.0 }, y: Vec4 { x: 2.0, y: 3.0, z: 2.0, w: 2.0 }, z: Vec4 { x: 1.0, y: 2.0, z: 3.0, w: 3.0 }, w: Vec4 { x: 0.0, y: 1.0, z: 1.0, w: 0.0 } }; let f1 = 0.5; let mut mut_a: mat4 = a; let mut mut_c: mat4 = c; mut_a.swap_cols(0, 3); assert_eq!(mut_a.col(0), a.col(3)); assert_eq!(mut_a.col(3), a.col(0)); mut_a = a; mut_a.swap_cols(1, 2); assert_eq!(mut_a.col(1), a.col(2)); assert_eq!(mut_a.col(2), a.col(1)); mut_a = a; mut_a.swap_rows(0, 3); assert_eq!(mut_a.row(0), a.row(3)); assert_eq!(mut_a.row(3), a.row(0)); mut_a = a; mut_a.swap_rows(1, 2); assert_eq!(mut_a.row(1), a.row(2)); assert_eq!(mut_a.row(2), a.row(1)); mut_a = a; mut_a.set(&b); assert_eq!(mut_a, b); mut_a = a; mut_a.to_identity(); assert!(mut_a.is_identity()); mut_a = a; mut_a.to_zero(); assert_eq!(mut_a, mat4::zero()); mut_a = a; mut_a.mul_self_t(f1); assert_eq!(mut_a, a.mul_t(f1)); mut_a = a; mut_a.add_self_m(&b); assert_eq!(mut_a, a.add_m(&b)); mut_a = a; mut_a.sub_self_m(&b); assert_eq!(mut_a, a.sub_m(&b)); mut_a = a; mut_c.invert_self(); assert_eq!(mut_c, c.inverse().unwrap()); // mut_c = c; mut_a.transpose_self(); assert_eq!(mut_a, a.transpose()); // mut_a = a; } #[test] fn test_mat4_approx_eq() { assert!(!mat4::new(0.000001, 0.000001, 0.000001, 0.000001, 0.000001, 0.000001, 0.000001, 0.000001, 0.000001, 0.000001, 0.000001, 0.000001, 0.000001, 0.000001, 0.000001, 0.000001).approx_eq(&mat4::zero())); assert!(mat4::new(0.0000001, 0.0000001, 0.0000001, 0.0000001, 0.0000001, 0.0000001, 0.0000001, 0.0000001, 0.0000001, 0.0000001, 0.0000001, 0.0000001, 0.0000001, 0.0000001, 0.0000001, 0.0000001).approx_eq(&mat4::zero())); }