Simple Vector Library 1.5 http://www.cs.cmu.edu/~ajw/doc/svl.html
Vec.cpp@1:e25ff4b06ed2, 2016-01-05 (annotated)
- Committer:
- BartJanssens
- Date:
- Tue Jan 05 13:37:50 2016 +0000
- Revision:
- 1:e25ff4b06ed2
- Parent:
- 0:785cff1e5a7c
fixed va_list bug
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
BartJanssens | 0:785cff1e5a7c | 1 | /* |
BartJanssens | 0:785cff1e5a7c | 2 | File: Vec.cpp |
BartJanssens | 0:785cff1e5a7c | 3 | |
BartJanssens | 0:785cff1e5a7c | 4 | Function: Implements Vec.h |
BartJanssens | 0:785cff1e5a7c | 5 | |
BartJanssens | 0:785cff1e5a7c | 6 | Author(s): Andrew Willmott |
BartJanssens | 0:785cff1e5a7c | 7 | |
BartJanssens | 0:785cff1e5a7c | 8 | Copyright: (c) 1995-2001, Andrew Willmott |
BartJanssens | 0:785cff1e5a7c | 9 | |
BartJanssens | 0:785cff1e5a7c | 10 | */ |
BartJanssens | 0:785cff1e5a7c | 11 | |
BartJanssens | 0:785cff1e5a7c | 12 | |
BartJanssens | 0:785cff1e5a7c | 13 | #include "Vec.h" |
BartJanssens | 0:785cff1e5a7c | 14 | |
BartJanssens | 0:785cff1e5a7c | 15 | //#include <cctype> |
BartJanssens | 0:785cff1e5a7c | 16 | //#include <cstring> |
BartJanssens | 1:e25ff4b06ed2 | 17 | #include <cstdarg> |
BartJanssens | 0:785cff1e5a7c | 18 | //#include <iomanip> |
BartJanssens | 0:785cff1e5a7c | 19 | #include "Vec2.h" |
BartJanssens | 0:785cff1e5a7c | 20 | #include "Vec3.h" |
BartJanssens | 0:785cff1e5a7c | 21 | #include "Vec4.h" |
BartJanssens | 0:785cff1e5a7c | 22 | |
BartJanssens | 0:785cff1e5a7c | 23 | // --- Vec Constructors ------------------------------------------------------- |
BartJanssens | 0:785cff1e5a7c | 24 | |
BartJanssens | 0:785cff1e5a7c | 25 | |
BartJanssens | 0:785cff1e5a7c | 26 | Vec::Vec(Int n, ZeroOrOne k) : elts(n) |
BartJanssens | 0:785cff1e5a7c | 27 | { |
BartJanssens | 0:785cff1e5a7c | 28 | Assert(n > 0,"(Vec) illegal vector size"); |
BartJanssens | 0:785cff1e5a7c | 29 | |
BartJanssens | 0:785cff1e5a7c | 30 | data = new Real[n]; |
BartJanssens | 0:785cff1e5a7c | 31 | |
BartJanssens | 0:785cff1e5a7c | 32 | MakeBlock(k); |
BartJanssens | 0:785cff1e5a7c | 33 | } |
BartJanssens | 0:785cff1e5a7c | 34 | |
BartJanssens | 0:785cff1e5a7c | 35 | Vec::Vec(Int n, Axis a) : elts(n) |
BartJanssens | 0:785cff1e5a7c | 36 | { |
BartJanssens | 0:785cff1e5a7c | 37 | Assert(n > 0,"(Vec) illegal vector size"); |
BartJanssens | 0:785cff1e5a7c | 38 | |
BartJanssens | 0:785cff1e5a7c | 39 | data = new Real[n]; |
BartJanssens | 0:785cff1e5a7c | 40 | |
BartJanssens | 0:785cff1e5a7c | 41 | MakeUnit(a); |
BartJanssens | 0:785cff1e5a7c | 42 | } |
BartJanssens | 0:785cff1e5a7c | 43 | |
BartJanssens | 0:785cff1e5a7c | 44 | Vec::Vec(const Vec &v) |
BartJanssens | 0:785cff1e5a7c | 45 | { |
BartJanssens | 0:785cff1e5a7c | 46 | Assert(v.data != 0, "(Vec) Can't construct from a null vector"); |
BartJanssens | 0:785cff1e5a7c | 47 | |
BartJanssens | 0:785cff1e5a7c | 48 | elts = v.Elts(); |
BartJanssens | 0:785cff1e5a7c | 49 | data = new Real[elts]; |
BartJanssens | 0:785cff1e5a7c | 50 | |
BartJanssens | 0:785cff1e5a7c | 51 | #ifdef VL_USE_MEMCPY |
BartJanssens | 0:785cff1e5a7c | 52 | memcpy(data, v.Ref(), sizeof(Real) * Elts()); |
BartJanssens | 0:785cff1e5a7c | 53 | #else |
BartJanssens | 0:785cff1e5a7c | 54 | for (Int i = 0; i < Elts(); i++) |
BartJanssens | 0:785cff1e5a7c | 55 | data[i] = v[i]; |
BartJanssens | 0:785cff1e5a7c | 56 | #endif |
BartJanssens | 0:785cff1e5a7c | 57 | } |
BartJanssens | 0:785cff1e5a7c | 58 | |
BartJanssens | 0:785cff1e5a7c | 59 | Vec::Vec(const Vec2 &v) : data(v.Ref()), elts(v.Elts() | VL_REF_FLAG) |
BartJanssens | 0:785cff1e5a7c | 60 | { |
BartJanssens | 0:785cff1e5a7c | 61 | } |
BartJanssens | 0:785cff1e5a7c | 62 | |
BartJanssens | 0:785cff1e5a7c | 63 | Vec::Vec(const Vec3 &v) : data(v.Ref()), elts(v.Elts() | VL_REF_FLAG) |
BartJanssens | 0:785cff1e5a7c | 64 | { |
BartJanssens | 0:785cff1e5a7c | 65 | } |
BartJanssens | 0:785cff1e5a7c | 66 | |
BartJanssens | 0:785cff1e5a7c | 67 | Vec::Vec(const Vec4 &v) : data(v.Ref()), elts(v.Elts() | VL_REF_FLAG) |
BartJanssens | 0:785cff1e5a7c | 68 | { |
BartJanssens | 0:785cff1e5a7c | 69 | } |
BartJanssens | 0:785cff1e5a7c | 70 | |
BartJanssens | 0:785cff1e5a7c | 71 | Vec::Vec(Int n, double elt0, ...) : elts(n) |
BartJanssens | 0:785cff1e5a7c | 72 | { |
BartJanssens | 0:785cff1e5a7c | 73 | Assert(n > 0,"(Vec) illegal vector size"); |
BartJanssens | 0:785cff1e5a7c | 74 | |
BartJanssens | 0:785cff1e5a7c | 75 | va_list ap; |
BartJanssens | 0:785cff1e5a7c | 76 | Int i = 1; |
BartJanssens | 0:785cff1e5a7c | 77 | |
BartJanssens | 0:785cff1e5a7c | 78 | data = new Real[n]; |
BartJanssens | 0:785cff1e5a7c | 79 | va_start(ap, elt0); |
BartJanssens | 0:785cff1e5a7c | 80 | |
BartJanssens | 0:785cff1e5a7c | 81 | SetReal(data[0], elt0); |
BartJanssens | 0:785cff1e5a7c | 82 | |
BartJanssens | 0:785cff1e5a7c | 83 | while (--n) |
BartJanssens | 0:785cff1e5a7c | 84 | SetReal(data[i++], va_arg(ap, double)); |
BartJanssens | 0:785cff1e5a7c | 85 | |
BartJanssens | 0:785cff1e5a7c | 86 | va_end(ap); |
BartJanssens | 0:785cff1e5a7c | 87 | } |
BartJanssens | 0:785cff1e5a7c | 88 | |
BartJanssens | 0:785cff1e5a7c | 89 | Vec::~Vec() |
BartJanssens | 0:785cff1e5a7c | 90 | { |
BartJanssens | 0:785cff1e5a7c | 91 | Assert(elts != 0,"(Vec) illegal vector size"); |
BartJanssens | 0:785cff1e5a7c | 92 | |
BartJanssens | 0:785cff1e5a7c | 93 | if (!IsRef()) |
BartJanssens | 0:785cff1e5a7c | 94 | delete[] data; |
BartJanssens | 0:785cff1e5a7c | 95 | } |
BartJanssens | 0:785cff1e5a7c | 96 | |
BartJanssens | 0:785cff1e5a7c | 97 | |
BartJanssens | 0:785cff1e5a7c | 98 | // --- Vec Assignment Operators ----------------------------------------------- |
BartJanssens | 0:785cff1e5a7c | 99 | |
BartJanssens | 0:785cff1e5a7c | 100 | |
BartJanssens | 0:785cff1e5a7c | 101 | Vec &Vec::operator = (const Vec &v) |
BartJanssens | 0:785cff1e5a7c | 102 | { |
BartJanssens | 0:785cff1e5a7c | 103 | if (!IsRef()) |
BartJanssens | 0:785cff1e5a7c | 104 | SetSize(v.Elts()); |
BartJanssens | 0:785cff1e5a7c | 105 | else |
BartJanssens | 0:785cff1e5a7c | 106 | Assert(Elts() == v.Elts(), "(Vec::=) Vector sizes don't match"); |
BartJanssens | 0:785cff1e5a7c | 107 | |
BartJanssens | 0:785cff1e5a7c | 108 | #ifdef VL_USE_MEMCPY |
BartJanssens | 0:785cff1e5a7c | 109 | memcpy(data, v.data, sizeof(Real) * Elts()); |
BartJanssens | 0:785cff1e5a7c | 110 | #else |
BartJanssens | 0:785cff1e5a7c | 111 | for (Int i = 0; i < Elts(); i++) |
BartJanssens | 0:785cff1e5a7c | 112 | data[i] = v[i]; |
BartJanssens | 0:785cff1e5a7c | 113 | #endif |
BartJanssens | 0:785cff1e5a7c | 114 | |
BartJanssens | 0:785cff1e5a7c | 115 | return(SELF); |
BartJanssens | 0:785cff1e5a7c | 116 | } |
BartJanssens | 0:785cff1e5a7c | 117 | |
BartJanssens | 0:785cff1e5a7c | 118 | Vec &Vec::operator = (const Vec2 &v) |
BartJanssens | 0:785cff1e5a7c | 119 | { |
BartJanssens | 0:785cff1e5a7c | 120 | if (!IsRef()) |
BartJanssens | 0:785cff1e5a7c | 121 | SetSize(v.Elts()); |
BartJanssens | 0:785cff1e5a7c | 122 | else |
BartJanssens | 0:785cff1e5a7c | 123 | Assert(Elts() == v.Elts(), "(Vec::=) Vector sizes don't match"); |
BartJanssens | 0:785cff1e5a7c | 124 | |
BartJanssens | 0:785cff1e5a7c | 125 | data[0] = v[0]; |
BartJanssens | 0:785cff1e5a7c | 126 | data[1] = v[1]; |
BartJanssens | 0:785cff1e5a7c | 127 | |
BartJanssens | 0:785cff1e5a7c | 128 | return(SELF); |
BartJanssens | 0:785cff1e5a7c | 129 | } |
BartJanssens | 0:785cff1e5a7c | 130 | |
BartJanssens | 0:785cff1e5a7c | 131 | Vec &Vec::operator = (const Vec3 &v) |
BartJanssens | 0:785cff1e5a7c | 132 | { |
BartJanssens | 0:785cff1e5a7c | 133 | if (!IsRef()) |
BartJanssens | 0:785cff1e5a7c | 134 | SetSize(v.Elts()); |
BartJanssens | 0:785cff1e5a7c | 135 | else |
BartJanssens | 0:785cff1e5a7c | 136 | Assert(Elts() == v.Elts(), "(Vec::=) Vector sizes don't match"); |
BartJanssens | 0:785cff1e5a7c | 137 | |
BartJanssens | 0:785cff1e5a7c | 138 | data[0] = v[0]; |
BartJanssens | 0:785cff1e5a7c | 139 | data[1] = v[1]; |
BartJanssens | 0:785cff1e5a7c | 140 | data[2] = v[2]; |
BartJanssens | 0:785cff1e5a7c | 141 | |
BartJanssens | 0:785cff1e5a7c | 142 | return(SELF); |
BartJanssens | 0:785cff1e5a7c | 143 | } |
BartJanssens | 0:785cff1e5a7c | 144 | |
BartJanssens | 0:785cff1e5a7c | 145 | Vec &Vec::operator = (const Vec4 &v) |
BartJanssens | 0:785cff1e5a7c | 146 | { |
BartJanssens | 0:785cff1e5a7c | 147 | if (!IsRef()) |
BartJanssens | 0:785cff1e5a7c | 148 | SetSize(v.Elts()); |
BartJanssens | 0:785cff1e5a7c | 149 | else |
BartJanssens | 0:785cff1e5a7c | 150 | Assert(Elts() == v.Elts(), "(Vec::=) Vector sizes don't match"); |
BartJanssens | 0:785cff1e5a7c | 151 | |
BartJanssens | 0:785cff1e5a7c | 152 | data[0] = v[0]; |
BartJanssens | 0:785cff1e5a7c | 153 | data[1] = v[1]; |
BartJanssens | 0:785cff1e5a7c | 154 | data[2] = v[2]; |
BartJanssens | 0:785cff1e5a7c | 155 | data[3] = v[3]; |
BartJanssens | 0:785cff1e5a7c | 156 | |
BartJanssens | 0:785cff1e5a7c | 157 | return(SELF); |
BartJanssens | 0:785cff1e5a7c | 158 | } |
BartJanssens | 0:785cff1e5a7c | 159 | |
BartJanssens | 0:785cff1e5a7c | 160 | Void Vec::SetSize(Int ni) |
BartJanssens | 0:785cff1e5a7c | 161 | { |
BartJanssens | 0:785cff1e5a7c | 162 | Assert(ni > 0, "(Vec::SetSize) Illegal vector size"); |
BartJanssens | 0:785cff1e5a7c | 163 | UInt n = UInt(ni); |
BartJanssens | 0:785cff1e5a7c | 164 | |
BartJanssens | 0:785cff1e5a7c | 165 | if (!IsRef()) |
BartJanssens | 0:785cff1e5a7c | 166 | { |
BartJanssens | 0:785cff1e5a7c | 167 | // Don't reallocate if we already have enough storage |
BartJanssens | 0:785cff1e5a7c | 168 | |
BartJanssens | 0:785cff1e5a7c | 169 | if (n <= elts) |
BartJanssens | 0:785cff1e5a7c | 170 | { |
BartJanssens | 0:785cff1e5a7c | 171 | elts = n; |
BartJanssens | 0:785cff1e5a7c | 172 | return; |
BartJanssens | 0:785cff1e5a7c | 173 | } |
BartJanssens | 0:785cff1e5a7c | 174 | |
BartJanssens | 0:785cff1e5a7c | 175 | // Otherwise, delete old storage |
BartJanssens | 0:785cff1e5a7c | 176 | |
BartJanssens | 0:785cff1e5a7c | 177 | delete[] data; |
BartJanssens | 0:785cff1e5a7c | 178 | |
BartJanssens | 0:785cff1e5a7c | 179 | elts = n; |
BartJanssens | 0:785cff1e5a7c | 180 | data = new Real[elts]; |
BartJanssens | 0:785cff1e5a7c | 181 | } |
BartJanssens | 0:785cff1e5a7c | 182 | else |
BartJanssens | 0:785cff1e5a7c | 183 | Assert(false, "(Vec::SetSize) Can't resize a vector reference"); |
BartJanssens | 0:785cff1e5a7c | 184 | } |
BartJanssens | 0:785cff1e5a7c | 185 | |
BartJanssens | 0:785cff1e5a7c | 186 | Vec &Vec::MakeZero() |
BartJanssens | 0:785cff1e5a7c | 187 | { |
BartJanssens | 0:785cff1e5a7c | 188 | #ifdef VL_USE_MEMCPY |
BartJanssens | 0:785cff1e5a7c | 189 | memset(data, 0, sizeof(Real) * Elts()); |
BartJanssens | 0:785cff1e5a7c | 190 | #else |
BartJanssens | 0:785cff1e5a7c | 191 | Int j; |
BartJanssens | 0:785cff1e5a7c | 192 | |
BartJanssens | 0:785cff1e5a7c | 193 | for (j = 0; j < Elts(); j++) |
BartJanssens | 0:785cff1e5a7c | 194 | data[j] = vl_zero; |
BartJanssens | 0:785cff1e5a7c | 195 | #endif |
BartJanssens | 0:785cff1e5a7c | 196 | |
BartJanssens | 0:785cff1e5a7c | 197 | return(SELF); |
BartJanssens | 0:785cff1e5a7c | 198 | } |
BartJanssens | 0:785cff1e5a7c | 199 | |
BartJanssens | 0:785cff1e5a7c | 200 | Vec &Vec::MakeUnit(Int i, Real k) |
BartJanssens | 0:785cff1e5a7c | 201 | { |
BartJanssens | 0:785cff1e5a7c | 202 | MakeZero(); |
BartJanssens | 0:785cff1e5a7c | 203 | data[i] = k; |
BartJanssens | 0:785cff1e5a7c | 204 | |
BartJanssens | 0:785cff1e5a7c | 205 | return(SELF); |
BartJanssens | 0:785cff1e5a7c | 206 | } |
BartJanssens | 0:785cff1e5a7c | 207 | |
BartJanssens | 0:785cff1e5a7c | 208 | Vec &Vec::MakeBlock(Real k) |
BartJanssens | 0:785cff1e5a7c | 209 | { |
BartJanssens | 0:785cff1e5a7c | 210 | Int i; |
BartJanssens | 0:785cff1e5a7c | 211 | |
BartJanssens | 0:785cff1e5a7c | 212 | for (i = 0; i < Elts(); i++) |
BartJanssens | 0:785cff1e5a7c | 213 | data[i] = k; |
BartJanssens | 0:785cff1e5a7c | 214 | |
BartJanssens | 0:785cff1e5a7c | 215 | return(SELF); |
BartJanssens | 0:785cff1e5a7c | 216 | } |
BartJanssens | 0:785cff1e5a7c | 217 | |
BartJanssens | 0:785cff1e5a7c | 218 | |
BartJanssens | 0:785cff1e5a7c | 219 | // --- Vec In-Place operators ------------------------------------------------- |
BartJanssens | 0:785cff1e5a7c | 220 | |
BartJanssens | 0:785cff1e5a7c | 221 | |
BartJanssens | 0:785cff1e5a7c | 222 | Vec &Vec::operator += (const Vec &b) |
BartJanssens | 0:785cff1e5a7c | 223 | { |
BartJanssens | 0:785cff1e5a7c | 224 | Assert(Elts() == b.Elts(), "(Vec::+=) vector sizes don't match"); |
BartJanssens | 0:785cff1e5a7c | 225 | |
BartJanssens | 0:785cff1e5a7c | 226 | Int i; |
BartJanssens | 0:785cff1e5a7c | 227 | |
BartJanssens | 0:785cff1e5a7c | 228 | for (i = 0; i < Elts(); i++) |
BartJanssens | 0:785cff1e5a7c | 229 | data[i] += b[i]; |
BartJanssens | 0:785cff1e5a7c | 230 | |
BartJanssens | 0:785cff1e5a7c | 231 | return(SELF); |
BartJanssens | 0:785cff1e5a7c | 232 | } |
BartJanssens | 0:785cff1e5a7c | 233 | |
BartJanssens | 0:785cff1e5a7c | 234 | Vec &Vec::operator -= (const Vec &b) |
BartJanssens | 0:785cff1e5a7c | 235 | { |
BartJanssens | 0:785cff1e5a7c | 236 | Assert(Elts() == b.Elts(), "(Vec::-=) vector sizes don't match"); |
BartJanssens | 0:785cff1e5a7c | 237 | |
BartJanssens | 0:785cff1e5a7c | 238 | Int i; |
BartJanssens | 0:785cff1e5a7c | 239 | |
BartJanssens | 0:785cff1e5a7c | 240 | for (i = 0; i < Elts(); i++) |
BartJanssens | 0:785cff1e5a7c | 241 | data[i] -= b[i]; |
BartJanssens | 0:785cff1e5a7c | 242 | |
BartJanssens | 0:785cff1e5a7c | 243 | return(SELF); |
BartJanssens | 0:785cff1e5a7c | 244 | } |
BartJanssens | 0:785cff1e5a7c | 245 | |
BartJanssens | 0:785cff1e5a7c | 246 | Vec &Vec::operator *= (const Vec &b) |
BartJanssens | 0:785cff1e5a7c | 247 | { |
BartJanssens | 0:785cff1e5a7c | 248 | Assert(Elts() == b.Elts(), "(Vec::*=) Vec sizes don't match"); |
BartJanssens | 0:785cff1e5a7c | 249 | |
BartJanssens | 0:785cff1e5a7c | 250 | Int i; |
BartJanssens | 0:785cff1e5a7c | 251 | |
BartJanssens | 0:785cff1e5a7c | 252 | for (i = 0; i < Elts(); i++) |
BartJanssens | 0:785cff1e5a7c | 253 | data[i] *= b[i]; |
BartJanssens | 0:785cff1e5a7c | 254 | |
BartJanssens | 0:785cff1e5a7c | 255 | return(SELF); |
BartJanssens | 0:785cff1e5a7c | 256 | } |
BartJanssens | 0:785cff1e5a7c | 257 | |
BartJanssens | 0:785cff1e5a7c | 258 | Vec &Vec::operator *= (Real s) |
BartJanssens | 0:785cff1e5a7c | 259 | { |
BartJanssens | 0:785cff1e5a7c | 260 | Int i; |
BartJanssens | 0:785cff1e5a7c | 261 | |
BartJanssens | 0:785cff1e5a7c | 262 | for (i = 0; i < Elts(); i++) |
BartJanssens | 0:785cff1e5a7c | 263 | data[i] *= s; |
BartJanssens | 0:785cff1e5a7c | 264 | |
BartJanssens | 0:785cff1e5a7c | 265 | return(SELF); |
BartJanssens | 0:785cff1e5a7c | 266 | } |
BartJanssens | 0:785cff1e5a7c | 267 | |
BartJanssens | 0:785cff1e5a7c | 268 | Vec &Vec::operator /= (const Vec &b) |
BartJanssens | 0:785cff1e5a7c | 269 | { |
BartJanssens | 0:785cff1e5a7c | 270 | Assert(Elts() == b.Elts(), "(Vec::/=) Vec sizes don't match"); |
BartJanssens | 0:785cff1e5a7c | 271 | |
BartJanssens | 0:785cff1e5a7c | 272 | Int i; |
BartJanssens | 0:785cff1e5a7c | 273 | |
BartJanssens | 0:785cff1e5a7c | 274 | for (i = 0; i < Elts(); i++) |
BartJanssens | 0:785cff1e5a7c | 275 | data[i] /= b[i]; |
BartJanssens | 0:785cff1e5a7c | 276 | |
BartJanssens | 0:785cff1e5a7c | 277 | return(SELF); |
BartJanssens | 0:785cff1e5a7c | 278 | } |
BartJanssens | 0:785cff1e5a7c | 279 | |
BartJanssens | 0:785cff1e5a7c | 280 | Vec &Vec::operator /= (Real s) |
BartJanssens | 0:785cff1e5a7c | 281 | { |
BartJanssens | 0:785cff1e5a7c | 282 | Int i; |
BartJanssens | 0:785cff1e5a7c | 283 | |
BartJanssens | 0:785cff1e5a7c | 284 | for (i = 0; i < Elts(); i++) |
BartJanssens | 0:785cff1e5a7c | 285 | data[i] /= s; |
BartJanssens | 0:785cff1e5a7c | 286 | |
BartJanssens | 0:785cff1e5a7c | 287 | return(SELF); |
BartJanssens | 0:785cff1e5a7c | 288 | } |
BartJanssens | 0:785cff1e5a7c | 289 | |
BartJanssens | 0:785cff1e5a7c | 290 | |
BartJanssens | 0:785cff1e5a7c | 291 | // --- Vec Comparison Operators ----------------------------------------------- |
BartJanssens | 0:785cff1e5a7c | 292 | |
BartJanssens | 0:785cff1e5a7c | 293 | |
BartJanssens | 0:785cff1e5a7c | 294 | Bool operator == (const Vec &a, const Vec &b) |
BartJanssens | 0:785cff1e5a7c | 295 | { |
BartJanssens | 0:785cff1e5a7c | 296 | Int i; |
BartJanssens | 0:785cff1e5a7c | 297 | |
BartJanssens | 0:785cff1e5a7c | 298 | for (i = 0; i < a.Elts(); i++) |
BartJanssens | 0:785cff1e5a7c | 299 | if (a[i] != b[i]) |
BartJanssens | 0:785cff1e5a7c | 300 | return(0); |
BartJanssens | 0:785cff1e5a7c | 301 | |
BartJanssens | 0:785cff1e5a7c | 302 | return(1); |
BartJanssens | 0:785cff1e5a7c | 303 | } |
BartJanssens | 0:785cff1e5a7c | 304 | |
BartJanssens | 0:785cff1e5a7c | 305 | Bool operator != (const Vec &a, const Vec &b) |
BartJanssens | 0:785cff1e5a7c | 306 | { |
BartJanssens | 0:785cff1e5a7c | 307 | Int i; |
BartJanssens | 0:785cff1e5a7c | 308 | |
BartJanssens | 0:785cff1e5a7c | 309 | for (i = 0; i < a.Elts(); i++) |
BartJanssens | 0:785cff1e5a7c | 310 | if (a[i] != b[i]) |
BartJanssens | 0:785cff1e5a7c | 311 | return(1); |
BartJanssens | 0:785cff1e5a7c | 312 | |
BartJanssens | 0:785cff1e5a7c | 313 | return(0); |
BartJanssens | 0:785cff1e5a7c | 314 | } |
BartJanssens | 0:785cff1e5a7c | 315 | |
BartJanssens | 0:785cff1e5a7c | 316 | |
BartJanssens | 0:785cff1e5a7c | 317 | // --- Vec Arithmetic Operators ----------------------------------------------- |
BartJanssens | 0:785cff1e5a7c | 318 | |
BartJanssens | 0:785cff1e5a7c | 319 | |
BartJanssens | 0:785cff1e5a7c | 320 | Vec operator + (const Vec &a, const Vec &b) |
BartJanssens | 0:785cff1e5a7c | 321 | { |
BartJanssens | 0:785cff1e5a7c | 322 | Assert(a.Elts() == b.Elts(), "(Vec::+) Vec sizes don't match"); |
BartJanssens | 0:785cff1e5a7c | 323 | |
BartJanssens | 0:785cff1e5a7c | 324 | Vec result(a.Elts()); |
BartJanssens | 0:785cff1e5a7c | 325 | Int i; |
BartJanssens | 0:785cff1e5a7c | 326 | |
BartJanssens | 0:785cff1e5a7c | 327 | for (i = 0; i < a.Elts(); i++) |
BartJanssens | 0:785cff1e5a7c | 328 | result[i] = a[i] + b[i]; |
BartJanssens | 0:785cff1e5a7c | 329 | |
BartJanssens | 0:785cff1e5a7c | 330 | return(result); |
BartJanssens | 0:785cff1e5a7c | 331 | } |
BartJanssens | 0:785cff1e5a7c | 332 | |
BartJanssens | 0:785cff1e5a7c | 333 | Vec operator - (const Vec &a, const Vec &b) |
BartJanssens | 0:785cff1e5a7c | 334 | { |
BartJanssens | 0:785cff1e5a7c | 335 | Assert(a.Elts() == b.Elts(), "(Vec::-) Vec sizes don't match"); |
BartJanssens | 0:785cff1e5a7c | 336 | |
BartJanssens | 0:785cff1e5a7c | 337 | Vec result(a.Elts()); |
BartJanssens | 0:785cff1e5a7c | 338 | Int i; |
BartJanssens | 0:785cff1e5a7c | 339 | |
BartJanssens | 0:785cff1e5a7c | 340 | for (i = 0; i < a.Elts(); i++) |
BartJanssens | 0:785cff1e5a7c | 341 | result[i] = a[i] - b[i]; |
BartJanssens | 0:785cff1e5a7c | 342 | |
BartJanssens | 0:785cff1e5a7c | 343 | return(result); |
BartJanssens | 0:785cff1e5a7c | 344 | } |
BartJanssens | 0:785cff1e5a7c | 345 | |
BartJanssens | 0:785cff1e5a7c | 346 | Vec operator - (const Vec &v) |
BartJanssens | 0:785cff1e5a7c | 347 | { |
BartJanssens | 0:785cff1e5a7c | 348 | Vec result(v.Elts()); |
BartJanssens | 0:785cff1e5a7c | 349 | Int i; |
BartJanssens | 0:785cff1e5a7c | 350 | |
BartJanssens | 0:785cff1e5a7c | 351 | for (i = 0; i < v.Elts(); i++) |
BartJanssens | 0:785cff1e5a7c | 352 | result[i] = - v[i]; |
BartJanssens | 0:785cff1e5a7c | 353 | |
BartJanssens | 0:785cff1e5a7c | 354 | return(result); |
BartJanssens | 0:785cff1e5a7c | 355 | } |
BartJanssens | 0:785cff1e5a7c | 356 | |
BartJanssens | 0:785cff1e5a7c | 357 | Vec operator * (const Vec &a, const Vec &b) |
BartJanssens | 0:785cff1e5a7c | 358 | { |
BartJanssens | 0:785cff1e5a7c | 359 | Assert(a.Elts() == b.Elts(), "(Vec::*) Vec sizes don't match"); |
BartJanssens | 0:785cff1e5a7c | 360 | |
BartJanssens | 0:785cff1e5a7c | 361 | Vec result(a.Elts()); |
BartJanssens | 0:785cff1e5a7c | 362 | Int i; |
BartJanssens | 0:785cff1e5a7c | 363 | |
BartJanssens | 0:785cff1e5a7c | 364 | for (i = 0; i < a.Elts(); i++) |
BartJanssens | 0:785cff1e5a7c | 365 | result[i] = a[i] * b[i]; |
BartJanssens | 0:785cff1e5a7c | 366 | |
BartJanssens | 0:785cff1e5a7c | 367 | return(result); |
BartJanssens | 0:785cff1e5a7c | 368 | } |
BartJanssens | 0:785cff1e5a7c | 369 | |
BartJanssens | 0:785cff1e5a7c | 370 | Vec operator * (const Vec &v, Real s) |
BartJanssens | 0:785cff1e5a7c | 371 | { |
BartJanssens | 0:785cff1e5a7c | 372 | Vec result(v.Elts()); |
BartJanssens | 0:785cff1e5a7c | 373 | Int i; |
BartJanssens | 0:785cff1e5a7c | 374 | |
BartJanssens | 0:785cff1e5a7c | 375 | for (i = 0; i < v.Elts(); i++) |
BartJanssens | 0:785cff1e5a7c | 376 | result[i] = v[i] * s; |
BartJanssens | 0:785cff1e5a7c | 377 | |
BartJanssens | 0:785cff1e5a7c | 378 | return(result); |
BartJanssens | 0:785cff1e5a7c | 379 | } |
BartJanssens | 0:785cff1e5a7c | 380 | |
BartJanssens | 0:785cff1e5a7c | 381 | Vec operator / (const Vec &a, const Vec &b) |
BartJanssens | 0:785cff1e5a7c | 382 | { |
BartJanssens | 0:785cff1e5a7c | 383 | Assert(a.Elts() == b.Elts(), "(Vec::/) Vec sizes don't match"); |
BartJanssens | 0:785cff1e5a7c | 384 | |
BartJanssens | 0:785cff1e5a7c | 385 | Vec result(a.Elts()); |
BartJanssens | 0:785cff1e5a7c | 386 | Int i; |
BartJanssens | 0:785cff1e5a7c | 387 | |
BartJanssens | 0:785cff1e5a7c | 388 | for (i = 0; i < a.Elts(); i++) |
BartJanssens | 0:785cff1e5a7c | 389 | result[i] = a[i] / b[i]; |
BartJanssens | 0:785cff1e5a7c | 390 | |
BartJanssens | 0:785cff1e5a7c | 391 | return(result); |
BartJanssens | 0:785cff1e5a7c | 392 | } |
BartJanssens | 0:785cff1e5a7c | 393 | |
BartJanssens | 0:785cff1e5a7c | 394 | Vec operator / (const Vec &v, Real s) |
BartJanssens | 0:785cff1e5a7c | 395 | { |
BartJanssens | 0:785cff1e5a7c | 396 | Vec result(v.Elts()); |
BartJanssens | 0:785cff1e5a7c | 397 | Int i; |
BartJanssens | 0:785cff1e5a7c | 398 | |
BartJanssens | 0:785cff1e5a7c | 399 | for (i = 0; i < v.Elts(); i++) |
BartJanssens | 0:785cff1e5a7c | 400 | result[i] = v[i] / s; |
BartJanssens | 0:785cff1e5a7c | 401 | |
BartJanssens | 0:785cff1e5a7c | 402 | return(result); |
BartJanssens | 0:785cff1e5a7c | 403 | } |
BartJanssens | 0:785cff1e5a7c | 404 | |
BartJanssens | 0:785cff1e5a7c | 405 | Real dot(const Vec &a, const Vec &b) |
BartJanssens | 0:785cff1e5a7c | 406 | { |
BartJanssens | 0:785cff1e5a7c | 407 | Assert(a.Elts() == b.Elts(), "(Vec::dot) Vec sizes don't match"); |
BartJanssens | 0:785cff1e5a7c | 408 | |
BartJanssens | 0:785cff1e5a7c | 409 | Real sum = vl_zero; |
BartJanssens | 0:785cff1e5a7c | 410 | Int i; |
BartJanssens | 0:785cff1e5a7c | 411 | |
BartJanssens | 0:785cff1e5a7c | 412 | for (i = 0; i < a.Elts(); i++) |
BartJanssens | 0:785cff1e5a7c | 413 | sum += a[i] * b[i]; |
BartJanssens | 0:785cff1e5a7c | 414 | |
BartJanssens | 0:785cff1e5a7c | 415 | return(sum); |
BartJanssens | 0:785cff1e5a7c | 416 | } |
BartJanssens | 0:785cff1e5a7c | 417 | |
BartJanssens | 0:785cff1e5a7c | 418 | Vec operator * (Real s, const Vec &v) |
BartJanssens | 0:785cff1e5a7c | 419 | { |
BartJanssens | 0:785cff1e5a7c | 420 | Vec result(v.Elts()); |
BartJanssens | 0:785cff1e5a7c | 421 | Int i; |
BartJanssens | 0:785cff1e5a7c | 422 | |
BartJanssens | 0:785cff1e5a7c | 423 | for (i = 0; i < v.Elts(); i++) |
BartJanssens | 0:785cff1e5a7c | 424 | result[i] = v[i] * s; |
BartJanssens | 0:785cff1e5a7c | 425 | |
BartJanssens | 0:785cff1e5a7c | 426 | return(result); |
BartJanssens | 0:785cff1e5a7c | 427 | } |
BartJanssens | 0:785cff1e5a7c | 428 | |
BartJanssens | 0:785cff1e5a7c | 429 | Vec &Vec::Clamp(Real fuzz) |
BartJanssens | 0:785cff1e5a7c | 430 | // clamps all values of the matrix with a magnitude |
BartJanssens | 0:785cff1e5a7c | 431 | // smaller than fuzz to zero. |
BartJanssens | 0:785cff1e5a7c | 432 | { |
BartJanssens | 0:785cff1e5a7c | 433 | Int i; |
BartJanssens | 0:785cff1e5a7c | 434 | |
BartJanssens | 0:785cff1e5a7c | 435 | for (i = 0; i < Elts(); i++) |
BartJanssens | 0:785cff1e5a7c | 436 | if (len(SELF[i]) < fuzz) |
BartJanssens | 0:785cff1e5a7c | 437 | SELF[i] = vl_zero; |
BartJanssens | 0:785cff1e5a7c | 438 | |
BartJanssens | 0:785cff1e5a7c | 439 | return(SELF); |
BartJanssens | 0:785cff1e5a7c | 440 | } |
BartJanssens | 0:785cff1e5a7c | 441 | |
BartJanssens | 0:785cff1e5a7c | 442 | Vec &Vec::Clamp() |
BartJanssens | 0:785cff1e5a7c | 443 | { |
BartJanssens | 0:785cff1e5a7c | 444 | return(Clamp(1e-7)); |
BartJanssens | 0:785cff1e5a7c | 445 | } |
BartJanssens | 0:785cff1e5a7c | 446 | |
BartJanssens | 0:785cff1e5a7c | 447 | Vec clamped(const Vec &v, Real fuzz) |
BartJanssens | 0:785cff1e5a7c | 448 | // clamps all values of the matrix with a magnitude |
BartJanssens | 0:785cff1e5a7c | 449 | // smaller than fuzz to zero. |
BartJanssens | 0:785cff1e5a7c | 450 | { |
BartJanssens | 0:785cff1e5a7c | 451 | Vec result(v); |
BartJanssens | 0:785cff1e5a7c | 452 | |
BartJanssens | 0:785cff1e5a7c | 453 | return(result.Clamp(fuzz)); |
BartJanssens | 0:785cff1e5a7c | 454 | } |
BartJanssens | 0:785cff1e5a7c | 455 | |
BartJanssens | 0:785cff1e5a7c | 456 | Vec clamped(const Vec &v) |
BartJanssens | 0:785cff1e5a7c | 457 | { |
BartJanssens | 0:785cff1e5a7c | 458 | return(clamped(v, 1e-7)); |
BartJanssens | 0:785cff1e5a7c | 459 | } |
BartJanssens | 0:785cff1e5a7c | 460 | |
BartJanssens | 0:785cff1e5a7c | 461 | |
BartJanssens | 0:785cff1e5a7c | 462 | // --- Vec Input & Output ----------------------------------------------------- |
BartJanssens | 0:785cff1e5a7c | 463 | |
BartJanssens | 0:785cff1e5a7c | 464 | |
BartJanssens | 0:785cff1e5a7c | 465 | /* |
BartJanssens | 0:785cff1e5a7c | 466 | ostream &operator << (ostream &s, const Vec &v) |
BartJanssens | 0:785cff1e5a7c | 467 | { |
BartJanssens | 0:785cff1e5a7c | 468 | Int i, w; |
BartJanssens | 0:785cff1e5a7c | 469 | |
BartJanssens | 0:785cff1e5a7c | 470 | s << '['; |
BartJanssens | 0:785cff1e5a7c | 471 | |
BartJanssens | 0:785cff1e5a7c | 472 | if (v.Elts() > 0) |
BartJanssens | 0:785cff1e5a7c | 473 | { |
BartJanssens | 0:785cff1e5a7c | 474 | w = s.width(); |
BartJanssens | 0:785cff1e5a7c | 475 | s << v[0]; |
BartJanssens | 0:785cff1e5a7c | 476 | |
BartJanssens | 0:785cff1e5a7c | 477 | for (i = 1; i < v.Elts(); i++) |
BartJanssens | 0:785cff1e5a7c | 478 | s << ' ' << setw(w) << v[i]; |
BartJanssens | 0:785cff1e5a7c | 479 | } |
BartJanssens | 0:785cff1e5a7c | 480 | |
BartJanssens | 0:785cff1e5a7c | 481 | s << ']'; |
BartJanssens | 0:785cff1e5a7c | 482 | |
BartJanssens | 0:785cff1e5a7c | 483 | return(s); |
BartJanssens | 0:785cff1e5a7c | 484 | } |
BartJanssens | 0:785cff1e5a7c | 485 | */ |
BartJanssens | 0:785cff1e5a7c | 486 | |
BartJanssens | 0:785cff1e5a7c | 487 | inline Void CopyPartialVec(const Vec &u, Vec &v, Int numElts) |
BartJanssens | 0:785cff1e5a7c | 488 | { |
BartJanssens | 0:785cff1e5a7c | 489 | for (Int i = 0; i < numElts; i++) |
BartJanssens | 0:785cff1e5a7c | 490 | v[i] = u[i]; |
BartJanssens | 0:785cff1e5a7c | 491 | } |
BartJanssens | 0:785cff1e5a7c | 492 | |
BartJanssens | 0:785cff1e5a7c | 493 | /* |
BartJanssens | 0:785cff1e5a7c | 494 | istream &operator >> (istream &s, Vec &v) |
BartJanssens | 0:785cff1e5a7c | 495 | { |
BartJanssens | 0:785cff1e5a7c | 496 | Int size = 0; |
BartJanssens | 0:785cff1e5a7c | 497 | Vec inVec(16); |
BartJanssens | 0:785cff1e5a7c | 498 | Char c; |
BartJanssens | 0:785cff1e5a7c | 499 | |
BartJanssens | 0:785cff1e5a7c | 500 | // Expected format: [a b c d ...] |
BartJanssens | 0:785cff1e5a7c | 501 | |
BartJanssens | 0:785cff1e5a7c | 502 | while (isspace(s.peek())) // chomp white space |
BartJanssens | 0:785cff1e5a7c | 503 | s.get(c); |
BartJanssens | 0:785cff1e5a7c | 504 | |
BartJanssens | 0:785cff1e5a7c | 505 | if (s.peek() == '[') |
BartJanssens | 0:785cff1e5a7c | 506 | { |
BartJanssens | 0:785cff1e5a7c | 507 | s.get(c); |
BartJanssens | 0:785cff1e5a7c | 508 | |
BartJanssens | 0:785cff1e5a7c | 509 | |
BartJanssens | 0:785cff1e5a7c | 510 | while (isspace(s.peek())) // chomp white space |
BartJanssens | 0:785cff1e5a7c | 511 | s.get(c); |
BartJanssens | 0:785cff1e5a7c | 512 | |
BartJanssens | 0:785cff1e5a7c | 513 | while (s.peek() != ']') // resize if needed |
BartJanssens | 0:785cff1e5a7c | 514 | { |
BartJanssens | 0:785cff1e5a7c | 515 | if (size == inVec.Elts()) |
BartJanssens | 0:785cff1e5a7c | 516 | { |
BartJanssens | 0:785cff1e5a7c | 517 | Vec holdVec(inVec); |
BartJanssens | 0:785cff1e5a7c | 518 | |
BartJanssens | 0:785cff1e5a7c | 519 | inVec.SetSize(size * 2); |
BartJanssens | 0:785cff1e5a7c | 520 | CopyPartialVec(holdVec, inVec, size); |
BartJanssens | 0:785cff1e5a7c | 521 | } |
BartJanssens | 0:785cff1e5a7c | 522 | |
BartJanssens | 0:785cff1e5a7c | 523 | s >> inVec[size++]; // read an item |
BartJanssens | 0:785cff1e5a7c | 524 | |
BartJanssens | 0:785cff1e5a7c | 525 | if (!s) |
BartJanssens | 0:785cff1e5a7c | 526 | { |
BartJanssens | 0:785cff1e5a7c | 527 | _Warning("Couldn't read vector element"); |
BartJanssens | 0:785cff1e5a7c | 528 | return(s); |
BartJanssens | 0:785cff1e5a7c | 529 | } |
BartJanssens | 0:785cff1e5a7c | 530 | |
BartJanssens | 0:785cff1e5a7c | 531 | while (isspace(s.peek())) // chomp white space |
BartJanssens | 0:785cff1e5a7c | 532 | s.get(c); |
BartJanssens | 0:785cff1e5a7c | 533 | } |
BartJanssens | 0:785cff1e5a7c | 534 | s.get(c); |
BartJanssens | 0:785cff1e5a7c | 535 | } |
BartJanssens | 0:785cff1e5a7c | 536 | else |
BartJanssens | 0:785cff1e5a7c | 537 | { |
BartJanssens | 0:785cff1e5a7c | 538 | s.clear(ios::failbit); |
BartJanssens | 0:785cff1e5a7c | 539 | _Warning("Error: Expected '[' while reading vector"); |
BartJanssens | 0:785cff1e5a7c | 540 | return(s); |
BartJanssens | 0:785cff1e5a7c | 541 | } |
BartJanssens | 0:785cff1e5a7c | 542 | |
BartJanssens | 0:785cff1e5a7c | 543 | v.SetSize(size); |
BartJanssens | 0:785cff1e5a7c | 544 | CopyPartialVec(inVec, v, size); |
BartJanssens | 0:785cff1e5a7c | 545 | |
BartJanssens | 0:785cff1e5a7c | 546 | return(s); |
BartJanssens | 0:785cff1e5a7c | 547 | } |
BartJanssens | 0:785cff1e5a7c | 548 | */ |