libcruft-util/matrix.ipp

291 lines
9.4 KiB
Plaintext
Raw Normal View History

2015-02-19 13:24:37 +11:00
/*
2015-04-13 18:05:28 +10:00
* 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
2015-02-19 13:24:37 +11:00
*
2015-04-13 18:05:28 +10:00
* http://www.apache.org/licenses/LICENSE-2.0
2015-02-19 13:24:37 +11:00
*
2015-04-13 18:05:28 +10:00
* 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.
2015-02-19 13:24:37 +11:00
*
2015-10-30 23:40:13 +11:00
* Copyright 2011-2015 Danny Robson <danny@nerdcruft.net>
2015-02-19 13:24:37 +11:00
*/
#ifdef __UTIL_MATRIX_IPP
#error
#endif
#define __UTIL_MATRIX_IPP
///////////////////////////////////////////////////////////////////////////////
2017-02-21 21:19:28 +11:00
template <size_t Rows, size_t Cols, typename T>
T*
2017-02-21 21:19:28 +11:00
util::matrix<Rows,Cols,T>::operator[] (size_t idx)
{
return this->values[idx];
}
//-----------------------------------------------------------------------------
2017-02-21 21:19:28 +11:00
template <size_t Rows, size_t Cols, typename T>
const T*
2017-02-21 21:19:28 +11:00
util::matrix<Rows,Cols,T>::operator[] (size_t idx) const
{
return this->values[idx];
}
2017-01-05 19:49:43 +11:00
//-----------------------------------------------------------------------------
2017-02-21 21:19:28 +11:00
template <size_t Rows, size_t Cols, typename T>
2017-01-05 19:49:43 +11:00
T*
2017-02-21 21:19:28 +11:00
util::matrix<Rows,Cols,T>::data (void)
2017-01-05 19:49:43 +11:00
{
return begin ();
}
//-----------------------------------------------------------------------------
2017-02-21 21:19:28 +11:00
template <size_t Rows, size_t Cols, typename T>
2017-01-05 19:49:43 +11:00
const T*
2017-02-21 21:19:28 +11:00
util::matrix<Rows,Cols,T>::data (void) const
2017-01-05 19:49:43 +11:00
{
return begin ();
}
//-----------------------------------------------------------------------------
2017-02-21 21:19:28 +11:00
template <size_t Rows, size_t Cols, typename T>
const T*
2017-02-21 21:19:28 +11:00
util::matrix<Rows,Cols,T>::begin (void) const
{
return &(*this)[0][0];
}
//-----------------------------------------------------------------------------
2017-02-21 21:19:28 +11:00
template <size_t Rows, size_t Cols, typename T>
const T*
2017-02-21 21:19:28 +11:00
util::matrix<Rows,Cols,T>::end (void) const
{
2017-02-21 21:19:28 +11:00
return &(*this)[Rows][0];
}
//-----------------------------------------------------------------------------
2017-02-21 21:19:28 +11:00
template <size_t Rows, size_t Cols, typename T>
const T*
2017-02-21 21:19:28 +11:00
util::matrix<Rows,Cols,T>::cbegin (void) const
{
return begin ();
}
//-----------------------------------------------------------------------------
2017-02-21 21:19:28 +11:00
template <size_t Rows, size_t Cols, typename T>
const T*
2017-02-21 21:19:28 +11:00
util::matrix<Rows,Cols,T>::cend (void) const
{
return end ();
}
//-----------------------------------------------------------------------------
2017-02-21 21:19:28 +11:00
template <size_t Rows, size_t Cols, typename T>
T*
2017-02-21 21:19:28 +11:00
util::matrix<Rows,Cols,T>::begin (void)
{
return &(*this)[0][0];
}
//-----------------------------------------------------------------------------
2017-02-21 21:19:28 +11:00
template <size_t Rows, size_t Cols, typename T>
T*
2017-02-21 21:19:28 +11:00
util::matrix<Rows,Cols,T>::end (void)
{
2017-02-21 21:19:28 +11:00
return &(*this)[Rows][0];
}
///////////////////////////////////////////////////////////////////////////////
2017-02-21 21:19:28 +11:00
template <size_t Rows, size_t Cols, typename T>
2015-02-19 13:24:37 +11:00
template <typename U>
2017-02-21 21:19:28 +11:00
util::matrix<Rows,Cols,U>
util::matrix<Rows,Cols,T>::cast (void) const
2015-02-19 13:24:37 +11:00
{
2017-02-21 21:19:28 +11:00
util::matrix<Rows,Cols,T> out;
std::copy (cbegin (), cend (), std::begin (out));
return out;
}
2015-02-19 13:24:37 +11:00
2016-08-15 18:53:52 +10:00
///////////////////////////////////////////////////////////////////////////////
#define MATRIX_ELEMENT_OP(OP) \
2017-02-21 21:19:28 +11:00
template <size_t Rows, size_t Cols, typename T> \
2016-08-15 18:53:52 +10:00
constexpr \
2017-02-21 21:19:28 +11:00
util::matrix<Rows,Cols,T> \
2016-08-15 18:53:52 +10:00
util::operator OP ( \
2017-02-21 21:19:28 +11:00
const util::matrix<Rows,Cols,T> &a, \
const util::matrix<Rows,Cols,T> &b) \
2016-08-15 18:53:52 +10:00
{ \
2017-02-21 21:19:28 +11:00
util::matrix<Rows,Cols,T> res {}; \
2016-08-15 18:53:52 +10:00
\
for (size_t i = 0; i < a.rows; ++i) \
for (size_t j = 0; j < a.cols; ++j) \
res[i][j] = a[i][j] OP b[i][j]; \
\
return res; \
}
MATRIX_ELEMENT_OP(-)
MATRIX_ELEMENT_OP(+)
2016-08-15 20:32:24 +10:00
#undef MATRIX_ELEMENT_OP
///////////////////////////////////////////////////////////////////////////////
2017-02-21 21:19:28 +11:00
#define MATRIX_SCALAR_OP(OP) \
template <size_t Rows, size_t Cols, typename T> \
constexpr \
util::matrix<Rows,Cols,T> \
util::operator OP (const util::matrix<Rows,Cols,T> &m, const T t) \
{ \
util::matrix<Rows,Cols,T> res {}; \
\
std::transform ( \
std::cbegin (m), \
std::cend (m), \
std::begin (res), \
[&t] (auto x) { return x OP t; } \
); \
\
return res; \
} \
\
\
template <size_t Rows, size_t Cols, typename T> \
constexpr \
util::matrix<Rows,Cols,T> \
util::operator OP (const T t, const util::matrix<Rows,Cols,T> &m) \
{ \
return m OP t; \
} \
\
\
template <size_t Rows, size_t Cols, typename T> \
constexpr \
util::matrix<Rows,Cols,T>& \
util::operator OP##= (util::matrix<Rows,Cols,T> &m, T t) \
{ \
std::transform ( \
std::cbegin (m), \
std::cend (m), \
std::begin (m), \
[&t] (auto x) { return x OP t; } \
); \
\
return m; \
2016-08-15 20:32:24 +10:00
}
MATRIX_SCALAR_OP(*)
MATRIX_SCALAR_OP(/)
MATRIX_SCALAR_OP(+)
MATRIX_SCALAR_OP(-)
#undef MATRIX_SCALAR_OP
///////////////////////////////////////////////////////////////////////////////
2017-02-21 21:19:28 +11:00
template <
std::size_t R1, std::size_t C1,
std::size_t R2, std::size_t C2,
typename T
>
constexpr
util::matrix<R1,C2,T>
util::operator* (const matrix<R1,C1,T> &a, const matrix<R2,C2,T> &b)
{
static_assert (R2 == C1);
matrix<R1,C2,T> res {0};
for (size_t r = 0; r < R1; ++r)
for (size_t c = 0; c < C2; ++c)
for (size_t i = 0; i < R2; ++i)
res[r][c] += a[r][i] * b[i][c];
return res;
}
///////////////////////////////////////////////////////////////////////////////
template <size_t Rows, size_t Cols, typename T>
constexpr
2017-02-21 21:19:28 +11:00
util::matrix<Rows,Cols,T>
util::matrix<Rows,Cols,T>::zeroes (void)
{
return {0};
}
///////////////////////////////////////////////////////////////////////////////
2017-02-21 21:19:28 +11:00
template <size_t Rows, size_t Cols, typename T>
constexpr
2017-02-21 21:19:28 +11:00
util::matrix<Rows,Cols,T>
util::matrix<Rows,Cols,T>::identity (void)
{
2017-02-21 21:19:28 +11:00
static_assert (Rows == Cols);
auto m = zeroes ();
2017-02-21 21:19:28 +11:00
for (size_t i = 0; i < Rows; ++i)
m[i][i] = 1;
return m;
}
2016-08-15 20:32:24 +10:00
///////////////////////////////////////////////////////////////////////////////
2017-02-21 21:19:28 +11:00
template <size_t Rows, size_t Cols, typename T>
2016-08-15 20:32:24 +10:00
constexpr
bool
2017-02-21 21:19:28 +11:00
util::operator== (const matrix<Rows,Cols,T> &a, const matrix<Rows,Cols,T> &b)
2016-08-15 20:32:24 +10:00
{
return std::equal (std::cbegin (a), std::cend (a), std::cbegin (b));
}
//-----------------------------------------------------------------------------
2017-02-21 21:19:28 +11:00
template <size_t Rows, size_t Cols, typename T>
2016-08-15 20:32:24 +10:00
constexpr
bool
2017-02-21 21:19:28 +11:00
util::operator!= (const matrix<Rows,Cols,T> &a, const matrix<Rows,Cols,T> &b)
2016-08-15 20:32:24 +10:00
{
return !(a == b);
}
2016-08-15 18:53:52 +10:00
2016-08-15 18:44:27 +10:00
///////////////////////////////////////////////////////////////////////////////
2017-02-21 21:19:28 +11:00
template <size_t Rows, size_t Cols, typename T>
util::matrix<Rows,Cols,T>
util::abs (const util::matrix<Rows,Cols,T> &src)
2016-08-15 18:44:27 +10:00
{
2017-02-21 21:19:28 +11:00
util::matrix<Rows,Cols,T> dst;
2016-08-15 18:44:27 +10:00
std::transform (std::cbegin (src), std::cend (src), std::begin (dst), util::abs<T>);
return dst;
2015-02-19 13:24:37 +11:00
}
///////////////////////////////////////////////////////////////////////////////
2017-02-21 21:19:28 +11:00
template <size_t Rows, size_t Cols, typename T>
constexpr
T
2017-02-21 21:19:28 +11:00
util::sum (const util::matrix<Rows, Cols,T> &src)
{
return sum (std::cbegin (src), std::cend (src));
}