Go to the documentation of this file.00001
00002 #ifndef vnl_power_h_
00003 #define vnl_power_h_
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015 #include <vnl/vnl_matrix_fixed.h>
00016 #include <vnl/vnl_matrix.h>
00017 #include <vnl/vnl_inverse.h>
00018 #include <vcl_cassert.h>
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00030
00031 template <class T, unsigned int d>
00032 vnl_matrix_fixed<T,d,d> vnl_power(vnl_matrix_fixed<T,d,d> const& m, int n)
00033 {
00034 assert(n >= 0 || d <= 4);
00035 if (n == 0)
00036 return vnl_matrix_fixed<T,d,d>().set_identity();
00037 else if (n == 1 || m.is_identity())
00038 return m;
00039 else if (n < 0)
00040 return vnl_inverse(vnl_power(m, -n));
00041 else {
00042 vnl_matrix_fixed<T,d,d> r = vnl_power(m, n/2);
00043 return n%2==0 ? r * r : r * r * m;
00044 }
00045 }
00046
00047
00048
00049
00050
00051
00052
00053
00054
00055
00056
00057
00058 template <class T>
00059 vnl_matrix<T> vnl_power(vnl_matrix<T> const& m, int n)
00060 {
00061 assert(m.rows() == m.columns());
00062 assert(n >= 0 || m.rows() <= 4);
00063 if (n == 0)
00064 return vnl_matrix<T>(m.rows(),m.columns()).set_identity();
00065 else if (n == 1 || m.is_identity())
00066 return m;
00067 else if (n < 0 && m.rows() == 1)
00068 return vnl_power(vnl_matrix_fixed<T,1,1>(m),n).as_ref();
00069 else if (n < 0 && m.rows() == 2)
00070 return vnl_power(vnl_matrix_fixed<T,2,2>(m),n).as_ref();
00071 else if (n < 0 && m.rows() == 3)
00072 return vnl_power(vnl_matrix_fixed<T,3,3>(m),n).as_ref();
00073 else if (n < 0 && m.rows() == 4)
00074 return vnl_power(vnl_matrix_fixed<T,4,4>(m),n).as_ref();
00075 else {
00076 vnl_matrix<T> r = vnl_power(m, n/2);
00077 return n%2==0 ? r * r : r * r * m;
00078 }
00079 }
00080
00081 #endif // vnl_power_h_