cart-elc

Source code for CART-ELC
git clone git://git.laack.co/cart-elc.git
Log | Files | Refs | README | LICENSE

quatmul.cpp (1097B)


      1 #include <iostream>
      2 #include <Eigen/Core>
      3 #include <Eigen/Geometry>
      4 #include <bench/BenchTimer.h>
      5 
      6 using namespace Eigen; 
      7 
      8 template<typename Quat>
      9 EIGEN_DONT_INLINE void quatmul_default(const Quat& a, const Quat& b, Quat& c)
     10 {
     11   c = a * b;
     12 }
     13 
     14 template<typename Quat>
     15 EIGEN_DONT_INLINE void quatmul_novec(const Quat& a, const Quat& b, Quat& c)
     16 {
     17   c = internal::quat_product<0, Quat, Quat, typename Quat::Scalar, Aligned>::run(a,b);
     18 }
     19 
     20 template<typename Quat> void bench(const std::string& label)
     21 {
     22   int tries = 10;
     23   int rep = 1000000;
     24   BenchTimer t;
     25   
     26   Quat a(4, 1, 2, 3);
     27   Quat b(2, 3, 4, 5);
     28   Quat c;
     29   
     30   std::cout.precision(3);
     31   
     32   BENCH(t, tries, rep, quatmul_default(a,b,c));
     33   std::cout << label << " default " << 1e3*t.best(CPU_TIMER) << "ms  \t" << 1e-6*double(rep)/(t.best(CPU_TIMER)) << " M mul/s\n";
     34   
     35   BENCH(t, tries, rep, quatmul_novec(a,b,c));
     36   std::cout << label << " novec   " << 1e3*t.best(CPU_TIMER) << "ms  \t" << 1e-6*double(rep)/(t.best(CPU_TIMER)) << " M mul/s\n";
     37 }
     38 
     39 int main()
     40 {
     41   bench<Quaternionf>("float ");
     42   bench<Quaterniond>("double");
     43 
     44   return 0;
     45 
     46 }
     47