Revision d964148c utility/vector.h
utility/vector.h | ||
---|---|---|
1 | 1 |
/* |
2 | 2 |
Inertial Measurement Unit Maths Library |
3 | 3 |
Copyright (C) 2013-2014 Samuel Cowen |
4 |
www.camelsoftware.com
|
|
4 |
www.camelsoftware.com
|
|
5 | 5 |
|
6 | 6 |
This program is free software: you can redistribute it and/or modify |
7 | 7 |
it under the terms of the GNU General Public License as published by |
... | ... | |
32 | 32 |
template <uint8_t N> class Vector |
33 | 33 |
{ |
34 | 34 |
public: |
35 |
Vector()
|
|
36 |
{
|
|
37 |
p_vec = (double*)malloc(sizeof(double)*N+1);
|
|
35 |
Vector()
|
|
36 |
{
|
|
37 |
p_vec = &p_vec_data[0];
|
|
38 | 38 |
memset(p_vec, 0, sizeof(double)*N); |
39 |
}
|
|
39 |
}
|
|
40 | 40 |
|
41 |
Vector(double a)
|
|
42 |
{
|
|
43 |
p_vec = (double*)malloc(sizeof(double)*N+1);
|
|
41 |
Vector(double a)
|
|
42 |
{
|
|
43 |
p_vec = &p_vec_data[0];
|
|
44 | 44 |
memset(p_vec, 0, sizeof(double)*N); |
45 |
p_vec[0] = a;
|
|
46 |
}
|
|
45 |
p_vec[0] = a;
|
|
46 |
}
|
|
47 | 47 |
|
48 |
Vector(double a, double b)
|
|
49 |
{
|
|
50 |
p_vec = (double*)malloc(sizeof(double)*N+1);
|
|
48 |
Vector(double a, double b)
|
|
49 |
{
|
|
50 |
p_vec = &p_vec_data[0];
|
|
51 | 51 |
memset(p_vec, 0, sizeof(double)*N); |
52 |
p_vec[0] = a;
|
|
53 |
p_vec[1] = b;
|
|
54 |
}
|
|
52 |
p_vec[0] = a;
|
|
53 |
p_vec[1] = b;
|
|
54 |
}
|
|
55 | 55 |
|
56 |
Vector(double a, double b, double c)
|
|
57 |
{
|
|
58 |
p_vec = (double*)malloc(sizeof(double)*N+1);
|
|
56 |
Vector(double a, double b, double c)
|
|
57 |
{
|
|
58 |
p_vec = &p_vec_data[0];
|
|
59 | 59 |
memset(p_vec, 0, sizeof(double)*N); |
60 |
p_vec[0] = a;
|
|
61 |
p_vec[1] = b;
|
|
62 |
p_vec[2] = c;
|
|
63 |
}
|
|
60 |
p_vec[0] = a;
|
|
61 |
p_vec[1] = b;
|
|
62 |
p_vec[2] = c;
|
|
63 |
}
|
|
64 | 64 |
|
65 | 65 |
Vector(double a, double b, double c, double d) |
66 | 66 |
{ |
67 |
p_vec = (double*)malloc(sizeof(double)*N+1);
|
|
67 |
p_vec = &p_vec_data[0];
|
|
68 | 68 |
memset(p_vec, 0, sizeof(double)*N); |
69 | 69 |
p_vec[0] = a; |
70 |
p_vec[1] = b;
|
|
71 |
p_vec[2] = c;
|
|
72 |
p_vec[3] = d;
|
|
70 |
p_vec[1] = b;
|
|
71 |
p_vec[2] = c;
|
|
72 |
p_vec[3] = d;
|
|
73 | 73 |
} |
74 | 74 |
|
75 | 75 |
Vector(const Vector<N> &v) |
76 | 76 |
{ |
77 |
p_vec = (double*)malloc(sizeof(double)*N);
|
|
77 |
p_vec = &p_vec_data[0];
|
|
78 | 78 |
memset(p_vec, 0, sizeof(double)*N); |
79 | 79 |
for (int x = 0; x < N; x++ ) |
80 | 80 |
p_vec[x] = v.p_vec[x]; |
... | ... | |
82 | 82 |
|
83 | 83 |
~Vector() |
84 | 84 |
{ |
85 |
free(p_vec); |
|
86 | 85 |
} |
87 | 86 |
|
88 | 87 |
uint8_t n() { return N; } |
... | ... | |
157 | 156 |
{ |
158 | 157 |
for (int x = 0; x < N; x++ ) |
159 | 158 |
p_vec[x] = v.p_vec[x]; |
160 |
return *this;
|
|
159 |
return *this;
|
|
161 | 160 |
} |
162 | 161 |
|
163 | 162 |
double& operator [](int n) |
... | ... | |
218 | 217 |
|
219 | 218 |
private: |
220 | 219 |
double* p_vec; |
220 |
double p_vec_data[N]; |
|
221 | 221 |
}; |
222 | 222 |
|
223 | 223 |
|
Also available in: Unified diff