summaryrefslogtreecommitdiff
path: root/linalg.c
blob: 5c7c3c20884925fbca2c48344da1fa12c46b1f44 (plain)
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
/**
 * linalg.c
 * --------
 *
 * purpose: provide some algebra functions
 *
 * @author ilhan oezgen, wahyd, ilhan.oezgen@wahyd.tu-berlin.de
 * @date 15 apr 17
 * @date  3 may 17
 **/

// ----------------------------------------------------------------------------

#include <stdlib.h>
#include <math.h>
#include <omp.h>

#include "global.h"
#include "linalg.h"

// ----------------------------------------------------------------------------

/**
 * put a val into the diag matrix dia
 **/
void put(struct diag* dia, int r, int c, double val)
{

	int len_ids = dia->len_id;
	int len_d   = dia->len_d;

	int id = c - r;

	for (int i = 0; i < len_ids; i ++) {
		if (dia->ids[i] == id) {
			dia->values[i * len_d + r] = val;
			break;
		}
	}

}

/**
 * get a value (r,c) from diag matrix dia
 **/
double get(struct diag* dia, int r, int c)
{

	int len_ids =  dia->len_id;
	int len_d   =  dia->len_d;

	int id = c - r;
	double val = 0.0;

	for (int i = 0; i < len_ids; i ++) {
		if (dia->ids[i] == id) {
			val = dia->values[i * len_d + r];
			break;
		}
	}

	return val;

}

/**
 * calculate matrix vector multiplication
 **/
void multiply(struct diag* dia, double* v, double* av)
{

	int len_c = dia->len_c;
	int len_r = dia->len_r;

	#pragma omp parallel for
	for (int i = 0; i < len_r; i ++) {
		for (int j = 0; j < len_c; j ++) {
			av[i] = av[i] + get(dia, i, j) * v[j];
		}
	}

}

/**
 * return the dot product of vectors v1 and v2
 **/
double dot(double* v1, double* v2, int len)
{
	double dot_product = 0.0;
	for (int i = 0; i < len; i ++) {
		dot_product = dot_product + v1[i] * v2[i];
	}
	return dot_product;
}

/**
 * return the L2-norm of the vector
 **/
double norm(double* v, int len)
{
	return sqrt(dot(v, v, len));
}