[C++][algo] algorithm updateCollisionGeometry now optionally executes algorithm geometry to compute positions before updating collision objects's positions