1 // This file is part of Eigen, a lightweight C++ template library
2 // for linear algebra.
3 //
4 // Copyright (C) 2009 Gael Guennebaud <g.gael@free.fr>
5 //
6 // This Source Code Form is subject to the terms of the Mozilla
7 // Public License v. 2.0. If a copy of the MPL was not distributed
8 // with this file, You can obtain one at http://mozilla.org/MPL/2.0/.
9 
10 #include "main.h"
11 #include <unsupported/Eigen/AlignedVector3>
12 
13 template<typename Scalar>
alignedvector3()14 void alignedvector3()
15 {
16   Scalar s1 = internal::random<Scalar>();
17   Scalar s2 = internal::random<Scalar>();
18   typedef Matrix<Scalar,3,1> RefType;
19   typedef Matrix<Scalar,3,3> Mat33;
20   typedef AlignedVector3<Scalar> FastType;
21   RefType  r1(RefType::Random()), r2(RefType::Random()), r3(RefType::Random()),
22            r4(RefType::Random()), r5(RefType::Random()), r6(RefType::Random());
23   FastType f1(r1), f2(r2), f3(r3), f4(r4), f5(r5), f6(r6);
24   Mat33 m1(Mat33::Random());
25 
26   VERIFY_IS_APPROX(f1,r1);
27   VERIFY_IS_APPROX(f4,r4);
28 
29   VERIFY_IS_APPROX(f4+f1,r4+r1);
30   VERIFY_IS_APPROX(f4-f1,r4-r1);
31   VERIFY_IS_APPROX(f4+f1-f2,r4+r1-r2);
32   VERIFY_IS_APPROX(f4+=f3,r4+=r3);
33   VERIFY_IS_APPROX(f4-=f5,r4-=r5);
34   VERIFY_IS_APPROX(f4-=f5+f1,r4-=r5+r1);
35   VERIFY_IS_APPROX(f5+f1-s1*f2,r5+r1-s1*r2);
36   VERIFY_IS_APPROX(f5+f1/s2-s1*f2,r5+r1/s2-s1*r2);
37 
38   VERIFY_IS_APPROX(m1*f4,m1*r4);
39   VERIFY_IS_APPROX(f4.transpose()*m1,r4.transpose()*m1);
40 
41   VERIFY_IS_APPROX(f2.dot(f3),r2.dot(r3));
42   VERIFY_IS_APPROX(f2.cross(f3),r2.cross(r3));
43   VERIFY_IS_APPROX(f2.norm(),r2.norm());
44 
45   VERIFY_IS_APPROX(f2.normalized(),r2.normalized());
46 
47   VERIFY_IS_APPROX((f2+f1).normalized(),(r2+r1).normalized());
48 
49   f2.normalize();
50   r2.normalize();
51   VERIFY_IS_APPROX(f2,r2);
52 }
53 
test_alignedvector3()54 void test_alignedvector3()
55 {
56   for(int i = 0; i < g_repeat; i++) {
57     CALL_SUBTEST( alignedvector3<float>() );
58   }
59 }
60