mirror of
https://gitlab.com/libeigen/eigen.git
synced 2025-03-25 18:50:40 +08:00
an even more stable procedure
This commit is contained in:
parent
5beb2f4f0d
commit
1eae6d0fb9
@ -153,20 +153,31 @@ void eigen33(const Matrix& mat, Matrix& evecs, Vector& evals)
|
||||
// tmp.diagonal().array() -= evals(2);
|
||||
// evecs.col(2) = tmp.row(0).cross(tmp.row(1)).normalized();
|
||||
|
||||
// a slighlty more stable version:
|
||||
Matrix tmp;
|
||||
tmp = scaledMat;
|
||||
tmp.diagonal ().array () -= evals (2);
|
||||
evecs.col (2) = tmp.row (0).cross (tmp.row (1)).normalized ();
|
||||
tmp = scaledMat;
|
||||
tmp.diagonal ().array () -= evals (1);
|
||||
evecs.col(1) = tmp.row (0).cross(tmp.row (1));
|
||||
Scalar n1 = evecs.col(1).norm();
|
||||
if(n1<=Eigen::NumTraits<Scalar>::epsilon())
|
||||
evecs.col(1) = evecs.col(2).unitOrthogonal();
|
||||
// a more stable version:
|
||||
if((evals(2)-evals(0))<=Eigen::NumTraits<Scalar>::epsilon())
|
||||
{
|
||||
evecs.setIdentity();
|
||||
}
|
||||
else
|
||||
evecs.col(1) /= n1;
|
||||
evecs.col(0) = evecs.col(2).cross(evecs.col(1));
|
||||
{
|
||||
Matrix tmp;
|
||||
tmp = scaledMat;
|
||||
tmp.diagonal ().array () -= evals (2);
|
||||
evecs.col (2) = tmp.row (0).cross (tmp.row (1)).normalized ();
|
||||
|
||||
tmp = scaledMat;
|
||||
tmp.diagonal ().array () -= evals (1);
|
||||
evecs.col(1) = tmp.row (0).cross(tmp.row (1));
|
||||
Scalar n1 = evecs.col(1).norm();
|
||||
if(n1<=Eigen::NumTraits<Scalar>::epsilon())
|
||||
evecs.col(1) = evecs.col(2).unitOrthogonal();
|
||||
else
|
||||
evecs.col(1) /= n1;
|
||||
|
||||
// make sure that evecs[1] is orthogonal to evecs[2]
|
||||
evecs.col(1) = evecs.col(2).cross(evecs.col(1).cross(evecs.col(2))).normalized();
|
||||
evecs.col(0) = evecs.col(2).cross(evecs.col(1));
|
||||
}
|
||||
|
||||
// Rescale back to the original size.
|
||||
evals *= scale;
|
||||
|
Loading…
x
Reference in New Issue
Block a user