eigenutils.h
2.59 KB
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
/* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * *
* Copyright 2012 The MITRE Corporation *
* *
* 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 *
* *
* http://www.apache.org/licenses/LICENSE-2.0 *
* *
* 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. *
* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */
#ifndef EIGENUTILS_H
#define EIGENUTILS_H
#include <QDataStream>
#include <Eigen/Core>
#include <assert.h>
template<typename _Scalar, int _Rows, int _Cols, int _Options, int _MaxRows, int _MaxCols>
inline QDataStream &operator<<(QDataStream &stream, const Eigen::Matrix< _Scalar, _Rows, _Cols, _Options, _MaxRows, _MaxCols > &mat)
{
int r = mat.rows();
int c = mat.cols();
stream << r << c;
_Scalar *data = new _Scalar[r*c];
for (int i=0; i<r; i++)
for (int j=0; j<c; j++)
data[i*c+j] = mat(i, j);
int bytes = r*c*sizeof(_Scalar);
int bytes_written = stream.writeRawData((const char*)data, bytes);
if (bytes != bytes_written) qFatal("EigenUtils.h operator<< failure.");
delete[] data;
return stream;
}
template<typename _Scalar, int _Rows, int _Cols, int _Options, int _MaxRows, int _MaxCols>
inline QDataStream &operator>>(QDataStream &stream, Eigen::Matrix< _Scalar, _Rows, _Cols, _Options, _MaxRows, _MaxCols > &mat)
{
int r, c;
stream >> r >> c;
mat.resize(r, c);
_Scalar *data = new _Scalar[r*c];
int bytes = r*c*sizeof(_Scalar);
int bytes_read = stream.readRawData((char*)data, bytes);
if (bytes != bytes_read) qFatal("EigenUtils.h operator>> failure.");
for (int i=0; i<r; i++)
for (int j=0; j<c; j++)
mat(i, j) = data[i*c+j];
delete[] data;
return stream;
}
#endif // EIGENUTILS_H