265 |
|
outVec[0] = m[0][0]*a0 + m[0][1]*a1 + m[0][2]*a2; |
266 |
|
outVec[1] = m[1][0]*a0 + m[1][1]*a1 + m[1][2]*a2; |
267 |
|
outVec[2] = m[2][0]*a0 + m[2][1]*a1 + m[2][2]*a2; |
268 |
+ |
} |
269 |
+ |
|
270 |
+ |
void SimInfo::transposeMat3(double in[3][3], double out[3][3]) { |
271 |
+ |
double temp[3][3]; |
272 |
+ |
int i, j; |
273 |
+ |
|
274 |
+ |
for (i = 0; i < 3; i++) { |
275 |
+ |
for (j = 0; j < 3; j++) { |
276 |
+ |
temp[j][i] = in[i][j]; |
277 |
+ |
} |
278 |
+ |
} |
279 |
+ |
for (i = 0; i < 3; i++) { |
280 |
+ |
for (j = 0; j < 3; j++) { |
281 |
+ |
out[i][j] = temp[i][j]; |
282 |
+ |
} |
283 |
+ |
} |
284 |
|
} |
285 |
|
|
286 |
+ |
void SimInfo::printMat3(double A[3][3] ){ |
287 |
+ |
|
288 |
+ |
std::cerr |
289 |
+ |
<< "[ " << A[0][0] << ", " << A[0][1] << ", " << A[0][2] << " ]\n" |
290 |
+ |
<< "[ " << A[1][0] << ", " << A[1][1] << ", " << A[1][2] << " ]\n" |
291 |
+ |
<< "[ " << A[2][0] << ", " << A[2][1] << ", " << A[2][2] << " ]\n"; |
292 |
+ |
} |
293 |
+ |
|
294 |
+ |
void SimInfo::printMat9(double A[9] ){ |
295 |
+ |
|
296 |
+ |
std::cerr |
297 |
+ |
<< "[ " << A[0] << ", " << A[1] << ", " << A[2] << " ]\n" |
298 |
+ |
<< "[ " << A[3] << ", " << A[4] << ", " << A[5] << " ]\n" |
299 |
+ |
<< "[ " << A[6] << ", " << A[7] << ", " << A[8] << " ]\n"; |
300 |
+ |
} |
301 |
+ |
|
302 |
|
void SimInfo::calcBoxL( void ){ |
303 |
|
|
304 |
|
double dx, dy, dz, dsq; |