I tried the following code and the result is quite different from my data.

code:

ofstream OutCsv_LowerPartPts("DirectlyExportLowerPartPointsAfterTrans.csv",ios_base::out|ios_base::trunc); 
          OutCsv_LowerPartPts<<"step"<<","<<"time"<<","<<
                    "p1-x"<<","<<"p1-y"<<","<<"p1-z"<<","<<""<<","<<
                    "p2-x"<<","<<"p2-y"<<","<<"p2-z"<<","<<""<<","<<
                    "p3-x"<<","<<"p3-y"<<","<<"p3-z"<<","<<"\n";
          int nSteps = 1;
          //1. Calculate the first Group of Parameters. 
          while (iSMotionExactTime
          {
                    
                    iSwMotionStudy->SetTime(iSMotionExactTime); 
                    iSwMotionStudy->Play();
                    hr = iSwModel->Rebuild(swRebuildAll); 
                    ASSERT(SUCCEEDED(hr));
                    CComPtr iSwLowerPartTFMatrix; 
                    iSwLowerPart->get_Transform2(&iSwLowerPartTFMatrix);
                    set set_DistVertexGroup; 
  
                    //Find 30 Groups of Min Distances and record the time, distance, points.
                              double scaleConst = 1000.0;
                              double coord1_Cond_beforeT[] = {33.037357/scaleConst,          -14.203015/scaleConst,          -40.330425/scaleConst}; 
                              double coord2_Cond_beforeT[] = {33.199257/scaleConst,          -19.714636/scaleConst,          -32.071205/scaleConst}; 
                              double coord3_Cond_beforeT[] = {34.426662/scaleConst,          -18.545341/scaleConst,          -46.908047/scaleConst}; 
                              CComPtr mathUtils;
                              iSwApp->IGetMathUtility(&mathUtils);
                              CComPtr iSwPointLowerPartPoint1_beforeT,iSwPointLowerPartPoint2_beforeT,iSwPointLowerPartPoint3_beforeT = NULL;
                              hr = mathUtils->ICreatePoint(coord1_Cond_beforeT,&iSwPointLowerPartPoint1_beforeT);
                              ASSERT(SUCCEEDED(hr));
                              hr = mathUtils->ICreatePoint(coord2_Cond_beforeT,&iSwPointLowerPartPoint2_beforeT);
                              ASSERT(SUCCEEDED(hr));
                              hr = mathUtils->ICreatePoint(coord3_Cond_beforeT,&iSwPointLowerPartPoint3_beforeT);
                              ASSERT(SUCCEEDED(hr));
                              //hr = iSwPointLowerPartPoint_beforeT->put_IArrayData(coord_Cond_beforeT);
                              CComPtr iSwPointLowerPartPoint1_afterT,iSwPointLowerPartPoint2_afterT,iSwPointLowerPartPoint3_afterT; 
                              iSwPointLowerPartPoint1_beforeT->IMultiplyTransform(iSwLowerPartTFMatrix,&iSwPointLowerPartPoint1_afterT);
                              iSwPointLowerPartPoint2_beforeT->IMultiplyTransform(iSwLowerPartTFMatrix,&iSwPointLowerPartPoint2_afterT);
                              iSwPointLowerPartPoint3_beforeT->IMultiplyTransform(iSwLowerPartTFMatrix,&iSwPointLowerPartPoint3_afterT);
                              double coord1_Cond[] = {0.0, 0.0, 0.0};
                              double coord2_Cond[] = {0.0, 0.0, 0.0};
                              double coord3_Cond[] = {0.0, 0.0, 0.0};
                              iSwPointLowerPartPoint1_afterT->get_IArrayData(coord1_Cond);
                              iSwPointLowerPartPoint2_afterT->get_IArrayData(coord2_Cond);
                              iSwPointLowerPartPoint3_afterT->get_IArrayData(coord3_Cond);
                              OutCsv_LowerPartPts<
                                        scaleConst*(coord1_Cond[0])<<","<
                                        scaleConst*(coord2_Cond[0])<<","<
                                        scaleConst*(coord3_Cond[0])<<","<
                                        <<"\n";
  
                    nSteps++;
                    iSwMotionStudy->Stop();
                    iSMotionExactTime = iSMotionExactTime + ((double)TimeInterval)*0.001; 
          }
          OutCsv_LowerPartPts.close();

Program result:

Realtime data: