ravshan Gaziev

UT_QuaternionD qori;
UT_Matrix3D _mt;

for (int objindex = 1; objindex <= numobj; objindex++)
{

  // var sum weight
  float sum = 0;

  for (int i = 1; i <= numobj; i++){
    sum += GETWEIGHT(i);
  }

  UT_String DrvObjName;
  OPPATH(DrvObjName, objindex, t);

  UT_Matrix4D matN;
  OP_Node *drvObj = findNode(DrvObjName);
  drvObj->getWorldTransform( matN, context);

  // compute offset list
  if(GETWEIGHT()){

    UT_Matrix4D matTempDrv, matTempDrn;
    OP_Node *drnObj = findNode(DrnObjName);
    drnObj->getWorldTransform( matTempDrn, context);
    drvObj->getWorldTransform( matTempDrv, context);
    matTempDrv.invertDouble();
    offsetMat[objindex-1] = matTempDrn * matTempDrv;

  }

  matN = offsetMat[objindex-1] * matN * matInv;
              
  UT_Matrix3D mt;
  UT_Vector3D  _pos;
              
  // Rotate compute
  matN.extractRotate(mt);
  UT_QuaternionD orient;
  orient.updateFromArbitraryMatrix(mt);
  orient.normalize();
  qori += orient*(GETWEIGHT(objindex)/sum);
  matN.getTranslates(_pos);
              
  // Translate compute
  x += _pos.x()*(GETWEIGHT(objindex)/sum);
  y += _pos.y()*(GETWEIGHT(objindex)/sum);
  z += _pos.z()*(GETWEIGHT(objindex)/sum);

}

qori.normalize();
UT_Vector3D _qrot;
qori.getRotationMatrix(_mt);
_mt.crack(_qrot, UT_XformOrder::rstOrder(5));