Shuto Naruse / Mbed 2 deprecated Eurobot2012_Secondary

Eurobot2012_Secondary

Fork of Eurobot_2012_Secondary by Shuto Naruse

tvmet/meta/Matrix.h@1:cc2a9eb0bd55, 2012-10-17 (annotated)

Committer:
narshu
Date:
Wed Oct 17 22:25:31 2012 +0000
Revision:
1:cc2a9eb0bd55
Commit before publishing

Who changed what in which revision?

UserRevisionLine numberNew contents of line
narshu 1:cc2a9eb0bd55 1 /*
narshu 1:cc2a9eb0bd55 2 * Tiny Vector Matrix Library
narshu 1:cc2a9eb0bd55 3 * Dense Vector Matrix Libary of Tiny size using Expression Templates
narshu 1:cc2a9eb0bd55 4 *
narshu 1:cc2a9eb0bd55 5 * Copyright (C) 2001 - 2007 Olaf Petzold <opetzold@users.sourceforge.net>
narshu 1:cc2a9eb0bd55 6 *
narshu 1:cc2a9eb0bd55 7 * This library is free software; you can redistribute it and/or
narshu 1:cc2a9eb0bd55 8 * modify it under the terms of the GNU lesser General Public
narshu 1:cc2a9eb0bd55 9 * License as published by the Free Software Foundation; either
narshu 1:cc2a9eb0bd55 10 * version 2.1 of the License, or (at your option) any later version.
narshu 1:cc2a9eb0bd55 11 *
narshu 1:cc2a9eb0bd55 12 * This library is distributed in the hope that it will be useful,
narshu 1:cc2a9eb0bd55 13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
narshu 1:cc2a9eb0bd55 14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
narshu 1:cc2a9eb0bd55 15 * lesser General Public License for more details.
narshu 1:cc2a9eb0bd55 16 *
narshu 1:cc2a9eb0bd55 17 * You should have received a copy of the GNU lesser General Public
narshu 1:cc2a9eb0bd55 18 * License along with this library; if not, write to the Free Software
narshu 1:cc2a9eb0bd55 19 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
narshu 1:cc2a9eb0bd55 20 *
narshu 1:cc2a9eb0bd55 21 * $Id: Matrix.h,v 1.19 2007-06-23 15:58:59 opetzold Exp $
narshu 1:cc2a9eb0bd55 22 */
narshu 1:cc2a9eb0bd55 23
narshu 1:cc2a9eb0bd55 24 #ifndef TVMET_META_MATRIX_H
narshu 1:cc2a9eb0bd55 25 #define TVMET_META_MATRIX_H
narshu 1:cc2a9eb0bd55 26
narshu 1:cc2a9eb0bd55 27 #include <tvmet/NumericTraits.h>
narshu 1:cc2a9eb0bd55 28 #include <tvmet/xpr/Null.h>
narshu 1:cc2a9eb0bd55 29
narshu 1:cc2a9eb0bd55 30 namespace tvmet {
narshu 1:cc2a9eb0bd55 31
narshu 1:cc2a9eb0bd55 32 namespace meta {
narshu 1:cc2a9eb0bd55 33
narshu 1:cc2a9eb0bd55 34
narshu 1:cc2a9eb0bd55 35 /**
narshu 1:cc2a9eb0bd55 36 * \class Matrix Matrix.h "tvmet/meta/Matrix.h"
narshu 1:cc2a9eb0bd55 37 * \brief Meta %Matrix class using expression and meta templates.
narshu 1:cc2a9eb0bd55 38 */
narshu 1:cc2a9eb0bd55 39 template<std::size_t Rows, std::size_t Cols,
narshu 1:cc2a9eb0bd55 40 std::size_t M=0, std::size_t N=0>
narshu 1:cc2a9eb0bd55 41 class Matrix
narshu 1:cc2a9eb0bd55 42 {
narshu 1:cc2a9eb0bd55 43 Matrix();
narshu 1:cc2a9eb0bd55 44 Matrix(const Matrix&);
narshu 1:cc2a9eb0bd55 45 Matrix& operator=(const Matrix&);
narshu 1:cc2a9eb0bd55 46
narshu 1:cc2a9eb0bd55 47 private:
narshu 1:cc2a9eb0bd55 48 enum {
narshu 1:cc2a9eb0bd55 49 doRows = (M < Rows - 1) ? 1 : 0, /**< recursive counter Rows. */
narshu 1:cc2a9eb0bd55 50 doCols = (N < Cols - 1) ? 1 : 0 /**< recursive counter Cols. */
narshu 1:cc2a9eb0bd55 51 };
narshu 1:cc2a9eb0bd55 52
narshu 1:cc2a9eb0bd55 53 public:
narshu 1:cc2a9eb0bd55 54 /** assign an expression on columns on given row using the functional assign_fn. */
narshu 1:cc2a9eb0bd55 55 template<class Dest, class Src, class Assign>
narshu 1:cc2a9eb0bd55 56 static inline
narshu 1:cc2a9eb0bd55 57 void assign2(Dest& lhs, const Src& rhs, const Assign& assign_fn) {
narshu 1:cc2a9eb0bd55 58 assign_fn.apply_on(lhs(M, N), rhs(M, N));
narshu 1:cc2a9eb0bd55 59 Matrix<Rows * doCols, Cols * doCols,
narshu 1:cc2a9eb0bd55 60 M * doCols, (N+1) * doCols>::assign2(lhs, rhs, assign_fn);
narshu 1:cc2a9eb0bd55 61 }
narshu 1:cc2a9eb0bd55 62
narshu 1:cc2a9eb0bd55 63 /** assign an expression on row-wise using the functional assign_fn. */
narshu 1:cc2a9eb0bd55 64 template<class Dest, class Src, class Assign>
narshu 1:cc2a9eb0bd55 65 static inline
narshu 1:cc2a9eb0bd55 66 void assign(Dest& lhs, const Src& rhs, const Assign& assign_fn) {
narshu 1:cc2a9eb0bd55 67 Matrix<Rows, Cols,
narshu 1:cc2a9eb0bd55 68 M, 0>::assign2(lhs, rhs, assign_fn);
narshu 1:cc2a9eb0bd55 69 Matrix<Rows * doRows, Cols * doRows,
narshu 1:cc2a9eb0bd55 70 (M+1) * doRows, 0>::assign(lhs, rhs, assign_fn);
narshu 1:cc2a9eb0bd55 71 }
narshu 1:cc2a9eb0bd55 72
narshu 1:cc2a9eb0bd55 73 /** evaluate a given matrix expression, column wise. */
narshu 1:cc2a9eb0bd55 74 template<class E>
narshu 1:cc2a9eb0bd55 75 static inline
narshu 1:cc2a9eb0bd55 76 bool all_elements2(const E& e) {
narshu 1:cc2a9eb0bd55 77 if(!e(M, N)) return false;
narshu 1:cc2a9eb0bd55 78 return Matrix<Rows * doCols, Cols * doCols,
narshu 1:cc2a9eb0bd55 79 M * doCols, (N+1) * doCols>::all_elements2(e);
narshu 1:cc2a9eb0bd55 80 }
narshu 1:cc2a9eb0bd55 81
narshu 1:cc2a9eb0bd55 82 /** evaluate a given matrix expression, row wise. */
narshu 1:cc2a9eb0bd55 83 template<class E>
narshu 1:cc2a9eb0bd55 84 static inline
narshu 1:cc2a9eb0bd55 85 bool all_elements(const E& e) {
narshu 1:cc2a9eb0bd55 86 if(!Matrix<Rows, Cols, M, 0>::all_elements2(e) ) return false;
narshu 1:cc2a9eb0bd55 87 return Matrix<Rows * doRows, Cols * doRows,
narshu 1:cc2a9eb0bd55 88 (M+1) * doRows, 0>::all_elements(e);
narshu 1:cc2a9eb0bd55 89 }
narshu 1:cc2a9eb0bd55 90
narshu 1:cc2a9eb0bd55 91 /** evaluate a given matrix expression, column wise. */
narshu 1:cc2a9eb0bd55 92 template<class E>
narshu 1:cc2a9eb0bd55 93 static inline
narshu 1:cc2a9eb0bd55 94 bool any_elements2(const E& e) {
narshu 1:cc2a9eb0bd55 95 if(e(M, N)) return true;
narshu 1:cc2a9eb0bd55 96 return Matrix<Rows * doCols, Cols * doCols,
narshu 1:cc2a9eb0bd55 97 M * doCols, (N+1) * doCols>::any_elements2(e);
narshu 1:cc2a9eb0bd55 98 }
narshu 1:cc2a9eb0bd55 99
narshu 1:cc2a9eb0bd55 100 /** evaluate a given matrix expression, row wise. */
narshu 1:cc2a9eb0bd55 101 template<class E>
narshu 1:cc2a9eb0bd55 102 static inline
narshu 1:cc2a9eb0bd55 103 bool any_elements(const E& e) {
narshu 1:cc2a9eb0bd55 104 if(Matrix<Rows, Cols, M, 0>::any_elements2(e) ) return true;
narshu 1:cc2a9eb0bd55 105 return Matrix<Rows * doRows, Cols * doRows,
narshu 1:cc2a9eb0bd55 106 (M+1) * doRows, 0>::any_elements(e);
narshu 1:cc2a9eb0bd55 107 }
narshu 1:cc2a9eb0bd55 108
narshu 1:cc2a9eb0bd55 109 /** trace a given matrix expression. */
narshu 1:cc2a9eb0bd55 110 template<class E>
narshu 1:cc2a9eb0bd55 111 static inline
narshu 1:cc2a9eb0bd55 112 typename E::value_type
narshu 1:cc2a9eb0bd55 113 trace(const E& e) {
narshu 1:cc2a9eb0bd55 114 return e(M, N)
narshu 1:cc2a9eb0bd55 115 + Matrix<Rows * doCols, Cols * doCols,
narshu 1:cc2a9eb0bd55 116 (M+1) * doCols, (N+1) * doCols>::trace(e);
narshu 1:cc2a9eb0bd55 117 }
narshu 1:cc2a9eb0bd55 118
narshu 1:cc2a9eb0bd55 119 };
narshu 1:cc2a9eb0bd55 120
narshu 1:cc2a9eb0bd55 121
narshu 1:cc2a9eb0bd55 122 /**
narshu 1:cc2a9eb0bd55 123 * \class Matrix<0, 0, 0, 0> Matrix.h "tvmet/meta/Matrix.h"
narshu 1:cc2a9eb0bd55 124 * \brief Meta %Matrix specialized for recursion.
narshu 1:cc2a9eb0bd55 125 */
narshu 1:cc2a9eb0bd55 126 template<>
narshu 1:cc2a9eb0bd55 127 class Matrix<0, 0, 0, 0>
narshu 1:cc2a9eb0bd55 128 {
narshu 1:cc2a9eb0bd55 129 Matrix();
narshu 1:cc2a9eb0bd55 130 Matrix(const Matrix&);
narshu 1:cc2a9eb0bd55 131 Matrix& operator=(const Matrix&);
narshu 1:cc2a9eb0bd55 132
narshu 1:cc2a9eb0bd55 133 public:
narshu 1:cc2a9eb0bd55 134 template<class Dest, class Src, class Assign>
narshu 1:cc2a9eb0bd55 135 static inline void assign2(Dest&, const Src&, const Assign&) { }
narshu 1:cc2a9eb0bd55 136
narshu 1:cc2a9eb0bd55 137 template<class Dest, class Src, class Assign>
narshu 1:cc2a9eb0bd55 138 static inline void assign(Dest&, const Src&, const Assign&) { }
narshu 1:cc2a9eb0bd55 139
narshu 1:cc2a9eb0bd55 140 template<class E>
narshu 1:cc2a9eb0bd55 141 static inline bool all_elements2(const E&) { return true; }
narshu 1:cc2a9eb0bd55 142
narshu 1:cc2a9eb0bd55 143 template<class E>
narshu 1:cc2a9eb0bd55 144 static inline bool all_elements(const E&) { return true; }
narshu 1:cc2a9eb0bd55 145
narshu 1:cc2a9eb0bd55 146 template<class E>
narshu 1:cc2a9eb0bd55 147 static inline bool any_elements2(const E&) { return false; }
narshu 1:cc2a9eb0bd55 148
narshu 1:cc2a9eb0bd55 149 template<class E>
narshu 1:cc2a9eb0bd55 150 static inline bool any_elements(const E&) { return false; }
narshu 1:cc2a9eb0bd55 151
narshu 1:cc2a9eb0bd55 152 template<class E>
narshu 1:cc2a9eb0bd55 153 static inline XprNull trace(const E&) { return XprNull(); }
narshu 1:cc2a9eb0bd55 154 };
narshu 1:cc2a9eb0bd55 155
narshu 1:cc2a9eb0bd55 156
narshu 1:cc2a9eb0bd55 157 } // namespace meta
narshu 1:cc2a9eb0bd55 158
narshu 1:cc2a9eb0bd55 159 } // namespace tvmet
narshu 1:cc2a9eb0bd55 160
narshu 1:cc2a9eb0bd55 161 #endif /* TVMET_META_MATRIX_H */
narshu 1:cc2a9eb0bd55 162
narshu 1:cc2a9eb0bd55 163 // Local Variables:
narshu 1:cc2a9eb0bd55 164 // mode:C++
narshu 1:cc2a9eb0bd55 165 // tab-width:8
narshu 1:cc2a9eb0bd55 166 // End: