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
|
/**
* @file matrix.c
* @author Gertjan van den Burg (burg@ese.eur.nl)
* @date August 8, 2013
* @brief Functions facilitating matrix access
*
* @details
* The functions contained in this file are used when
* accessing or writing to matrices. Seperate functions
* exist of adding and multiplying existing matrix
* elements, to ensure this is done in place.
*
*/
#include "matrix.h"
#include "util.h"
/**
* @name matrix_set
* @brief Set element of matrix
* @ingroup matrix
*
* Row-Major order is used to set a matrix element. Since matrices
* of type double are most common in MSVMMaj, this function only
* deals with that type.
*
* @param [in] M matrix to set element of
* @param [in] cols number of columns of M
* @param [in] i row index of element to write to
* @param [in] j column index of element to write to
* @param [out] val value to write to specified element of M
*/
void matrix_set(double *M, long cols, long i, long j, double val)
{
M[i*cols+j] = val;
}
double matrix_get(double *M, long cols, long i, long j)
{
return M[i*cols+j];
}
void matrix_add(double *M, long cols, long i, long j, double val)
{
M[i*cols+j] += val;
}
void matrix_mul(double *M, long cols, long i, long j, double val)
{
M[i*cols+j] *= val;
}
void matrix3_set(double *M, long N2, long N3, long i, long j,
long k, double val)
{
M[k+N3*(j+N2*i)] = val;
}
double matrix3_get(double *M, long N2, long N3, long i, long j,
long k)
{
return M[k+N3*(j+N2*i)];
}
void print_matrix(double *M, long rows, long cols)
{
long i, j;
for (i=0; i<rows; i++) {
for (j=0; j<cols; j++)
note("%8.8f ", matrix_get(M, cols, i, j));
note("\n");
}
note("\n");
}
|
