[algorithm] shaftProx in if check and normalize

th-skam · th-skam · commit a5d6c2d54c53 · 2025-08-11T15:21:04.000+02:00
diff --git a/src/sofa/collisionAlgorithm/algorithm/InsertionAlgorithm.h b/src/sofa/collisionAlgorithm/algorithm/InsertionAlgorithm.h
@@ -253,7 +253,10 @@ class InsertionAlgorithm : public BaseAlgorithm
             {
                 const BaseProximity::SPtr shaftProx = findClosestProxOnShaft(
                     m_couplingPts[i], l_shaftGeom.get(), projectOnShaft, getFilterFunc());
-                insertionOutput.add(shaftProx, m_couplingPts[i]);
+                if(shaftProx) {
+                    shaftProx->normalize();
+                    insertionOutput.add(shaftProx, m_couplingPts[i]);
+                }
             }
         }
 

Original file line number	Diff line number	Diff line change
`@@ -253,7 +253,10 @@ class InsertionAlgorithm : public BaseAlgorithm`
`253`	`253`	`{`
`254`	`254`	`const BaseProximity::SPtr shaftProx = findClosestProxOnShaft(`
`255`	`255`	`m_couplingPts[i], l_shaftGeom.get(), projectOnShaft, getFilterFunc());`
`256`		`- insertionOutput.add(shaftProx, m_couplingPts[i]);`
	`256`	`+ if(shaftProx) {`
	`257`	`+ shaftProx->normalize();`
	`258`	`+ insertionOutput.add(shaftProx, m_couplingPts[i]);`
	`259`	`+ }`
`257`	`260`	`}`
`258`	`261`	`}`
`259`	`262`