jiri/LA_library
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

gauss elimination for vecmat3

Browse Source
This commit is contained in:
Jiri Pittner
2021-11-21 00:08:09 +01:00
parent 30f4d29d82
commit 0b3a6c5473
3 changed files with 117 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files

15
vecmat3.cc
View File

@@ -522,7 +522,7 @@ q[2][1]=q[1][2]=tmp;
//
//numeric_limits not available on some crosscompilers for small MCUs
#ifdef ARM_SOURCE37
#ifdef QUAT_NO_DOUBLE
#define DBL_EPSILON 1.19209290e-07f
#else
#define DBL_EPSILON std::numeric_limits<T>::epsilon()
@@ -785,6 +785,19 @@ Mat3<T> A(*this); //scratch copy
//end eigensolver for 3x3 matrix
/////////////////////////////////////////////////////////////////////////////////////////////
template<typename T>
T Mat3<T>::norm(const T scalar) const
{
T sum(0);
for(int i=0; i<3; i++)
for(int j=0; j<3; j++) {
T tmp = q[i][j];
if(i == j) tmp -= scalar;
sum += tmp*tmp;
}
return sqrt(sum);
}
//force instantization
#define INSTANTIZE(T) \
template class Vec3<T>; \