forked from andrewprock/ustl
-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathumatrix.h
118 lines (111 loc) · 4.73 KB
/
umatrix.h
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
// This file is part of the uSTL library, an STL implementation.
//
// Copyright (c) 2005 by Mike Sharov <[email protected]>
// This file is free software, distributed under the MIT License.
#pragma once
#include "utuple.h"
namespace ustl {
/// \class matrix umatrix.h ustl.h
/// \ingroup Sequences
///
/// \brief A two-dimensional array of NX*NY elements of type T.
///
template <size_t NX, size_t NY, typename T>
class matrix : public tuple<NX*NY,T> {
public:
typedef tuple<NX,T> row_type;
typedef tuple<NY,T> column_type;
typedef tuple<NX*NY,T> tuple_type;
typedef typename tuple_type::value_type value_type;
typedef typename tuple_type::size_type size_type;
typedef typename tuple_type::pointer pointer;
typedef typename tuple_type::const_pointer const_pointer;
typedef typename tuple_type::reference reference;
typedef typename tuple_type::const_reference const_reference;
typedef typename tuple_type::iterator iterator;
typedef typename tuple_type::const_iterator const_iterator;
typedef typename tuple_type::range_t range_t;
typedef typename tuple_type::const_range_t const_range_t;
typedef typename tuple_type::reverse_iterator reverse_iterator;
typedef typename tuple_type::const_reverse_iterator const_reverse_iterator;
public:
inline matrix (void) : tuple<NX*NY,T>() { }
inline size_type columns (void) const { return NX; }
inline size_type rows (void) const { return NY; }
inline const_iterator at (size_type i) const { return matrix::begin() + i * NX; }
inline iterator at (size_type i) { return matrix::begin() + i * NX; }
inline const_iterator operator[] (size_type i) const { return at (i); }
inline iterator operator[] (size_type i) { return at (i); }
inline row_type row (size_type r) const { return row_type (at (r)); }
inline column_type column (size_type c) const;
template <typename T2>
inline const matrix& operator= (const matrix<NX,NY,T2>& src) { tuple_type::operator= (src); return *this; }
inline const matrix& operator= (const matrix<NX,NY,T>& src) { tuple_type::operator= (src); return *this; }
inline const matrix& operator+= (const_reference v) { tuple_type::operator+= (v); return *this; }
inline const matrix& operator-= (const_reference v) { tuple_type::operator-= (v); return *this; }
inline const matrix& operator*= (const_reference v) { tuple_type::operator*= (v); return *this; }
inline const matrix& operator/= (const_reference v) { tuple_type::operator/= (v); return *this; }
inline const matrix operator+ (const_reference v) const
{ matrix result (*this); result += v; return result; }
inline const matrix operator- (const_reference v) const
{ matrix result (*this); result -= v; return result; }
inline const matrix operator* (const_reference v) const
{ matrix result (*this); result *= v; return result; }
inline const matrix operator/ (const_reference v) const
{ matrix result (*this); result /= v; return result; }
void text_write (ostringstream& os) const;
};
template <size_t NX, size_t NY, typename T>
inline typename matrix<NX,NY,T>::column_type matrix<NX,NY,T>::column (size_type c) const
{
column_type result;
const_iterator src (matrix::begin() + c);
iterator dest (result.begin());
for (uoff_t i = 0; i < NY; ++ i, ++ dest, src += NX)
*dest = *src;
return result;
}
//----------------------------------------------------------------------
// Define SIMD specializations for member functions.
#if CPU_HAS_SSE
#define MATRIX_R(v) "m"(v[0]),"m"(v[4]),"m"(v[8]),"m"(v[12])
#define MATRIX_W(v) "=m"(v[0]),"=m"(v[4]),"=m"(v[8]),"=m"(v[12])
#define SSE_TUPLE_SPECS(n,type) \
template <> inline tuple<n,type>::tuple (void) \
{ asm volatile ("xorps %%xmm0, %%xmm0\n\t" \
"movups %%xmm0, %0\n\t" \
"movups %%xmm0, %1\n\t" \
"movups %%xmm0, %2\n\t" \
"movups %%xmm0, %3" \
: "=m"(_v[0]),"=m"(_v[4]),"=m"(_v[8]),"=m"(_v[12]) \
::"xmm0","memory"); \
} \
namespace simd { \
SIMD_PASSIGN_SPEC(n,type) \
{ \
asm volatile ("movups %2, %%xmm0\n\t" \
"movups %3, %%xmm1\n\t" \
"movups %%xmm0, %0\n\t" \
"movups %%xmm1, %1" \
: "=m"(oout[0]),"=m"(oout[4]) \
: "m"(oin[0]),"m"(oin[4]) \
: "xmm0", "xmm1", "memory"); \
asm volatile ("movups %2, %%xmm0\n\t" \
"movups %3, %%xmm1\n\t" \
"movups %%xmm0, %0\n\t" \
"movups %%xmm1, %1" \
: "=m"(oout[8]),"=m"(oout[12]) \
: "m"(oin[8]),"m"(oin[12]) \
: "xmm0", "xmm1", "memory"); \
} \
}
SSE_TUPLE_SPECS(16,float)
SSE_TUPLE_SPECS(16,int32_t)
SSE_TUPLE_SPECS(16,uint32_t)
#undef SSE_TUPLE_SPECS
#undef TOUCH_MATRIX_R
#undef TOUCH_MATRIX_W
#undef MATRIX_R
#undef MATRIX_W
#endif
} // namespace ustl