Skip to content

Commit a68dd81

Browse files
committed
Fix dampedInverse
1 parent 08bda64 commit a68dd81

File tree

1 file changed

+2
-6
lines changed

1 file changed

+2
-6
lines changed

include/sot/core/matrix-svd.hh

Lines changed: 2 additions & 6 deletions
Original file line numberDiff line numberDiff line change
@@ -61,9 +61,7 @@ void dampedInverse( dg::Matrix& _inputMatrix,
6161
JacobiSVD<dg::Matrix>::SingularValuesType singularValues_inv;
6262
singularValues_inv.resizeLike(m_singularValues);
6363
for ( long i=0; i<m_singularValues.size(); ++i) {
64-
if ( m_singularValues(i) > threshold )
65-
singularValues_inv(i)=m_singularValues(i)/(m_singularValues(i)*m_singularValues(i)+threshold*threshold);
66-
else singularValues_inv(i)=0;
64+
singularValues_inv(i)=m_singularValues(i)/(m_singularValues(i)*m_singularValues(i)+threshold*threshold);
6765
}
6866
dg::Matrix matrix_U(svd.matrixU());
6967
dg::Matrix matrix_V(svd.matrixV());
@@ -83,9 +81,7 @@ void dampedInverse( dg::Matrix& _inputMatrix,
8381
JacobiSVD<dg::Matrix>::SingularValuesType singularValues_inv;
8482
singularValues_inv.resizeLike(m_singularValues);
8583
for ( long i=0; i<m_singularValues.size(); ++i) {
86-
if ( m_singularValues(i) > threshold )
87-
singularValues_inv(i)=m_singularValues(i)/(m_singularValues(i)*m_singularValues(i)+threshold*threshold);
88-
else singularValues_inv(i)=0;
84+
singularValues_inv(i)=m_singularValues(i)/(m_singularValues(i)*m_singularValues(i)+threshold*threshold);
8985
}
9086
dg::Matrix Uref(svd.matrixU());
9187
dg::Matrix Vref(svd.matrixV());

0 commit comments

Comments
 (0)