[timer] Add advanced timers in the InsertionAlgorithm

Author: th-skam

src/CollisionAlgorithm/algorithm/InsertionAlgorithm.h

@@ -135,6 +135,8 @@ class InsertionAlgorithm : public BaseAlgorithm
         if (m_couplingPts.empty())
         {
             // Operations on surface geometry
+            sofa::helper::AdvancedTimer::stepBegin("Puncture detection - "+this->getName());
+
             auto findClosestProxOnSurf =
                 Operations::FindClosestProximity::Operation::get(l_surfGeom);
             auto projectOnSurf = Operations::Project::Operation::get(l_surfGeom);
@@ -181,8 +183,11 @@ class InsertionAlgorithm : public BaseAlgorithm
                     }
                 }
             }
+            sofa::helper::AdvancedTimer::stepEnd("Puncture detection - "+this->getName());
 
             // Shaft collision sequence - Disable if coupling points have been added
+            sofa::helper::AdvancedTimer::stepBegin("Shaft collision - "+this->getName());
+
             if (d_enableShaftCollision.getValue() && m_couplingPts.empty())
             {
                 auto createShaftProximity =
@@ -216,10 +221,12 @@ class InsertionAlgorithm : public BaseAlgorithm
                     }
                 }
             }
+            sofa::helper::AdvancedTimer::stepEnd("Shaft collision - "+this->getName());
         }
         else
         {
             // Insertion sequence
+            sofa::helper::AdvancedTimer::stepBegin("Needle insertion - " + this->getName());
             if (!d_enableInsertion.getValue()) return;
 
             ElementIterator::SPtr itTip = l_tipGeom->begin();
@@ -318,9 +325,11 @@ class InsertionAlgorithm : public BaseAlgorithm
                     Operations::Needle::PrunePointsAheadOfTip::get(itShaft->getTypeInfo());
                 prunePointsAheadOfTip(m_couplingPts, itShaft->element());
             }
+            sofa::helper::AdvancedTimer::stepEnd("Needle insertion - " + this->getName());
         }
 
-        if (d_enableInsertion.getValue() && !m_couplingPts.empty())
+        sofa::helper::AdvancedTimer::stepBegin("Reproject coupling points - "+this->getName());
+        if (!m_couplingPts.empty())
         {
             // Reprojection on shaft geometry sequence
             auto findClosestProxOnShaft =
@@ -339,6 +348,7 @@ class InsertionAlgorithm : public BaseAlgorithm
             // because the needle has exited abruptly. Thus, we clear the coupling points.
             if (insertionOutput.size() == 0) m_couplingPts.clear();
         }
+        sofa::helper::AdvancedTimer::stepEnd("Reproject coupling points - "+this->getName());
 
         d_collisionOutput.endEdit();
         d_insertionOutput.endEdit();