fix penalty

jdtuck · Aug 20, 2023 · 0f9746b · 0f9746b
1 parent a97c2a0
commit 0f9746b
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/src/fdasrsf/DP.cpp b/src/fdasrsf/DP.cpp
@@ -224,7 +224,7 @@ double CostFn2(const double *q1L, const double *q2L, int k, int l, int i, int j,
 				tmp_pen = acos(q1dotq2)*acos(q1dotq2);
 			}
 
-			tmp = q1L[n*x + d] - sqrtm*q2L[n*idx + d];
+			tmp = q1L[n*x + d] - q2L[n*idx + d];
 			E += (tmp*tmp + lam*tmp_pen);
 		}
 	}