plelemrotlt.cpp

Finite element program for mechanical problem. It can solve various problem in solid problem

    
    solve_lsm (lsm,lhs,rhs,Mp->zero,3,ncomp[ii]);
    Mt->stress_nodal_values (nodes,nxi,neta,nxi,lhs,2,cncomp[ii],ncomp[ii],lcid);
    
    
    delete [] lhs;  delete [] rhs;
    destrv (auxsig);  destrv (sig);  destrv (eps);  destrv (w);  destrv (gp1);  destrv (gp2);
  }
  
  delete [] lsm;
}

void planeelemrotlt::elem_stresses (double **stra,double **stre,long lcid,long eid,long ri,long ci)
{
  long i,ii,jj,ipp;
  double *lsm,*lhs,*rhs;
  vector gp1,gp2,w,nxi(nne),neta(nne),eps,sig,auxsig,natcoord(2);
  ivector nodes(nne);
  matrix d(tncomp,tncomp),dd;

  lsm = new double [9];
  
  nodecoord (nxi,neta);
  Mt->give_elemnodes (eid,nodes);
  
  for (ii=0;ii<nb;ii++){
    allocv (intordsm[ii][ii],gp1);
    allocv (intordsm[ii][ii],gp2);
    allocv (intordsm[ii][ii],w);
    allocv (ncomp[ii],sig);
    allocv (ncomp[ii],auxsig);
    lhs = new double [ncomp[ii]*3];
    rhs = new double [ncomp[ii]*3];
    gauss_points_tr (gp1.a,gp2.a,w.a,intordsm[ii][ii]);
    
    nullv (lsm,9);
    nullv (rhs,ncomp[ii]*3);
    
    ipp=Mt->elements[eid].ipp[ri+ii][ci+ii];
    
    for (i=0;i<intordsm[ii][ii];i++){
      Mm->matstiff (d,ipp);
      ipp++;
      
      fillv (0.0,sig);
      for (jj=0;jj<nb;jj++){
	allocv (ncomp[jj],eps);
	allocm (ncomp[ii],ncomp[jj],dd);
	
	if (Mp->strainaver==0)
	  appval (gp1[i],gp2[i],cncomp[jj],ncomp[jj],eps,stra);
	if (Mp->strainaver==1)
	  appstrain (lcid,eid,gp1[i],gp2[i],cncomp[jj],ncomp[jj],eps);
	
	dmatblock (ii,jj,d,dd);
	mxv (dd,eps,auxsig);
	addv (auxsig,sig,sig);
	destrm (dd);  destrv (eps);
      }
      
      natcoord[0]=gp1[i];  natcoord[1]=gp2[i];
      matassem_lsm (lsm,natcoord);
      rhsassem_lsm (rhs,natcoord,sig);
    }
    
    solve_lsm (lsm,lhs,rhs,Mp->zero,3,ncomp[ii]);
    nodal_values (stre,nxi,neta,nxi,lhs,2,cncomp[ii],ncomp[ii]);
    
    
    delete [] lhs;  delete [] rhs;
    destrv (sig);  destrv (eps);
  }
  
  delete [] lsm;
}

/**
   function computes stresses in arbitrary point on element
   
   @param eid - element id
   @param xi, eta - natural coordinates of the point
   @param fi,li - first and last indices
   @param sig - array containing stresses
   
   11.5.2002
*/
void planeelemrotlt::appstress (long lcid,long eid,double xi,double eta,long fi,long ncomp,vector &sig)
{
  long i,j,k;
  ivector nodes(nne);
  vector areacoord(3),nodval(nne);
  
  if (ncomp != sig.n){
    fprintf (stderr,"\n\n wrong interval of indices in function stress (%s, line %d).\n",__FILE__,__LINE__);
    abort ();
  }

  areacoord[0]=xi;
  areacoord[1]=eta;
  areacoord[2]=1.0-areacoord[0]-areacoord[1];

  Mt->give_elemnodes (eid,nodes);
  k=0;
  for (i=fi;i<fi+ncomp;i++){
    for (j=0;j<nne;j++){
      nodval[j]=Mt->nodes[nodes[j]].stress[lcid*tncomp+i];
    }
    sig[k]=approx (areacoord,nodval);
    k++;
  }
  
}

void planeelemrotlt::allip_stresses (double **stre,long lcid,long eid,long ri,long ci)
{
  long i,ii,jj,ipp;
  vector sig(tncomp),gp1,gp2,w;
  
  for (ii=0;ii<nb;ii++){
    for (jj=0;jj<nb;jj++){
      if (intordsm[ii][jj]==0)  continue;
      allocv (intordsm[ii][jj],gp1);
      allocv (intordsm[ii][jj],gp2);
      allocv (intordsm[ii][jj],w);
      gauss_points_tr (gp1.a,gp2.a,w.a,intordsm[ii][jj]);
      ipp=Mt->elements[eid].ipp[ri+ii][ci+jj];
      
      for (i=0;i<intordsm[ii][jj];i++){
        
        if (Mp->stressaver==0)
          appval (gp1[i],gp2[i],0,tncomp,sig,stre);
        if (Mp->stressaver==1)
          appstress (lcid,eid,gp1[i],gp2[i],0,tncomp,sig);

        Mm->storestress (lcid,ipp,sig);
        ipp++;
      }
    }
    destrv (w);  destrv (gp1);  destrv (gp2);
  }
}

void planeelemrotlt::stresses (long lcid,long eid,long ri,long ci)
{
  long i,naep,ncp,sid;
  double **stra,**stre;
  vector coord,sig;
  
  if (Mp->stressaver==0){
    stra = new double* [nne];
    stre = new double* [nne];
    for (i=0;i<nne;i++){
      stra[i] = new double [tncomp];
      stre[i] = new double [tncomp];
    }
    elem_strains (stra,lcid,eid,ri,ci);
    elem_stresses (stra,stre,lcid,eid,ri,ci);
  }

  switch (Mm->stre.tape[eid]){
  case nowhere:{
    break;
  }
  case intpts:{
    allip_stresses (stre,lcid,eid,ri,ci);
    break;
  }
  case enodes:{
    break;
  }
  case userdefined:{
    //  number of auxiliary element points
    naep = Mm->stre.give_naep (eid);
    ncp = Mm->stre.give_ncomp (eid);
    sid = Mm->stre.give_sid (eid);
    allocv (ncp,sig);
    allocv (2,coord);
    for (i=0;i<naep;i++){
      Mm->stre.give_aepcoord (sid,i,coord);

      if (Mp->stressaver==0)
        appval (coord[0],coord[1],0,ncp,sig,stre);
      if (Mp->stressaver==1)
        appstress (lcid,eid,coord[0],coord[1],0,ncp,sig);

      Mm->stre.storevalues(lcid,eid,i,sig);
    }
    destrv (sig);
    destrv (coord);
    break;
  }
  default:{
    fprintf (stderr,"\n\n unknown stress point is required in function planeelemrotlt::stresses (%s, line %d).\n",__FILE__,__LINE__);
  }
  }

  if (Mp->stressaver==0){
    for (i=0;i<nne;i++){
      delete [] stra[i];
      delete [] stre[i];
    }
    delete [] stra;
    delete [] stre;
  }
}


/**
   function computes other values in nodes of element
   
   @param lcid - load case id
   @param eid - element id
   
   10.5.2002
*/
void planeelemrotlt::nod_others (long lcid,long eid,long ri,long ci)
{
  long i,ii,j,ncomp,ipp;
  double *lsm,*lhs,*rhs;
  vector nxi(nne),neta(nne),gp1,gp2,w,other,aux,natcoord(2),areacoord(3);
  ivector nodes(nne);

  lsm = new double [9];

  nodecoord (nxi,neta);
  Mt->give_elemnodes (eid,nodes);


  for (ii=0;ii<nb;ii++){
    allocv (intordsm[ii][ii],gp1);
    allocv (intordsm[ii][ii],gp2);
    allocv (intordsm[ii][ii],w);
    ipp=Mt->elements[eid].ipp[ri+ii][ci+ii];
    ncomp = Mm->ip[ipp].ncompother;
    allocv (ncomp,other);
    lhs = new double [ncomp*3];
    rhs = new double [ncomp*3];
    gauss_points_tr (gp1.a,gp2.a,w.a,intordsm[ii][ii]);
    
    nullv (lsm,9);
    nullv (rhs,ncomp*3);
    
    for (i=0;i<intordsm[ii][ii];i++){
      areacoord[0]=gp1[i];
      areacoord[1]=gp2[i];
      areacoord[2]=1.0-gp1[i]-gp2[i];
      
      for (j = 0; j < ncomp; j++)
        other[j] = Mm->ip[ipp].eqother[j];
      
      natcoord[0]=areacoord[0];  natcoord[1]=areacoord[1];
      matassem_lsm (lsm,natcoord);
      rhsassem_lsm (rhs,natcoord,other);
      
      ipp++;
    }
    
    solve_lsm (lsm,lhs,rhs,Mp->zero,3,ncomp);
    Mt->other_nodal_values (nodes,nxi,neta,nxi,lhs,2,0,ncomp,lcid);
    
    delete [] lhs;  delete [] rhs;
    destrv (other);  destrv (w);  destrv (gp1);  destrv (gp2);
  }
  
  delete [] lsm;
}




/**
   function computes internal forces
   
   @param lcid - number of load case
   @param eid - element id
   @param ifor - vector of internal forces

   28.7.2001
*/
void planeelemrotlt::internal_forces (long lcid,long eid,long ri,long ci,vector &ifor,vector &x,vector &y)
{
  long i,j,ii,ipp;
  double det,thick;
  double **stra;
  ivector nodes(nne);
  vector areacoord(3),t(nne),eps(tncomp),sig,contr(ndofe);
  vector w,gp1,gp2;
  matrix gm;

  stra = new double* [nne];
  for (i=0;i<nne;i++){
    stra[i] = new double [tncomp];
  }
  elem_strains (stra,lcid,eid,ri,ci);

  Mt->give_elemnodes (eid,nodes);
  Mc->give_thickness (eid,nodes,t);

  det = ((x[1]-x[0])*(y[2]-y[0])-(x[2]-x[0])*(y[1]-y[0]));

  fillv (0.0,ifor);
  
  for (ii=0;ii<nb;ii++){
    allocv (intordsm[ii][ii],gp1);
    allocv (intordsm[ii][ii],gp2);
    allocv (intordsm[ii][ii],w);
    allocm (ncomp[ii],ndofe,gm);
    allocv (ncomp[ii],sig);
    
    gauss_points_tr (gp1.a,gp2.a,w.a,intordsm[ii][ii]);
    
    ipp=Mt->elements[eid].ipp[ri+ii][ci+ii];
    
    
    for (i=0;i<intordsm[ii][ii];i++){
      areacoord[0]=gp1[i];
      areacoord[1]=gp2[i];
      areacoord[2]=1.0-gp1[i]-gp2[i];
      
      thick = approx (areacoord,t);
      
      appval (gp1[i],gp2[i],0,tncomp,eps,stra);
      Mm->storestrain (lcid,ipp,eps);
      
      Mm->computenlstresses (ipp);
      
      Mm->givestress (lcid,ipp,cncomp[ii],ncomp[ii],sig);
      geom_matrix_block (gm,ii,x,y,areacoord);
      mtxv (gm,sig,contr);
      
      cmulv (det*w[i]*thick,contr);
      
      for (j=0;j<contr.n;j++){
        ifor[j]+=contr[j];
      }
      
      ipp++;
    }
    destrv (w);  destrv (gp1);  destrv (gp2);
    destrm (gm);  destrv (sig);
  }
  for (i=0;i<nne;i++){
    delete [] stra[i];
  }
  delete [] stra;
}

void planeelemrotlt::res_internal_forces (long lcid,long eid,vector &ifor)
{
  vector x(nne),y(nne);
  Mt->give_node_coord2d (x,y,eid);
  internal_forces (lcid,eid,0,0,ifor,x,y);
}

/**
   function returns coordinates of integration points

   @param eid - element id
   @param ipp - integration point pointer
   @param ri,ci - row and column indices
   @param coord - vector of coordinates

   19.1.2002
*/
void planeelemrotlt::ipcoord (long eid,long ipp,long ri,long ci,vector &coord)
{
  long i,ii;
  vector x(nne),y(nne),areacoord(3),w(intordsm[ri][ci]),gp1(intordsm[ri][ci]),gp2(intordsm[ri][ci]);

  gauss_points_tr (gp1.a,gp2.a,w.a,intordsm[ri][ci]);
  Mt->give_node_coord2d (x,y,eid);
  ii=Mt->elements[eid].ipp[ri][ci];

  for (i=0;i<intordsm[ri][ci];i++){
    areacoord[0]=gp1[i];
    areacoord[1]=gp2[i];
    areacoord[2]=1.0-areacoord[0]-areacoord[1];

    if (ii==ipp){
      coord[0]=approx (areacoord,x);
      coord[1]=approx (areacoord,y);
      coord[2]=0.0;
    }
    ii++;
  }
}



void planeelemrotlt::inicipval(long eid, long ri, long ci, matrix &nodval, inictype *ictn)
{
  long i, j, k, ipp;
  long ii, jj, nv = nodval.n;
  long nstra;
  double xi, eta, ipval;
  vector w, gp1, gp2, anv(nne);

  nstra = 0;
  for (j = 0; j < nv; j++) // for all initial values
  {
    for(i = 0; i < nne; i++) // for all nodes on element
      anv[i] = nodval[i][j];
    for (ii = 0; ii < nb; ii++)
    {
      for (jj = 0; jj < nb; jj++)
      {
        ipp=Mt->elements[eid].ipp[ri+ii][ci+jj];
        if (intordsm[ii][jj] == 0)
          continue;
        allocv (intordsm[ii][jj],gp1);
        allocv (intordsm[ii][jj],gp2);
        allocv (intordsm[ii][jj],w);
        gauss_points_tr (gp1.a, gp2.a, w.a, intordsm[ii][jj]);
        for (k = 0; k < intordsm[ii][jj]; k++)
        {
          xi=gp1[k];
          eta=gp2[k];
          //  value in integration point
          ipval = approx_nat (xi,eta,anv);
          if ((ictn[i] & inistrain) && (j < Mm->ip[ipp].ncompstr))
          {
            Mm->ip[ipp].strain[j] += ipval;
            ipp++;
            continue;
          }
          if ((ictn[i] & inistress) && (j < nstra + Mm->ip[ipp].ncompstr))
          {
            Mm->ip[ipp].stress[j] += ipval;
            ipp++;
            continue;
          }
          if ((ictn[i] & iniother) && (j < nv))
          {
            Mm->ip[ipp].other[j] += ipval;
            ipp++;
            continue;
          }
          ipp++;
        }
        destrv(gp1);  destrv (gp2);  destrv (w);
      }
    }
    if (ictn[i] & inistrain) nstra++;
  }
}



/**
   function computes volume appropriate to integration point
   
   2.3.2004, JK
*/
void planeelemrotlt::ipvolume (long eid,long ri,long ci)
{
  long i,ii,jj,ipp;
  double jac;
  vector x(nne),y(nne),gp1,gp2,w;
  
  Mt->give_node_coord2d (x,y,eid);

  for (ii=0;ii<nb;ii++){
    for (jj=0;jj<nb;jj++){
      if (intordsm[ii][jj]==0)  continue;
      
      allocv (nip[ii][jj],gp1);
      allocv (nip[ii][jj],gp2);
      allocv (nip[ii][jj],w);
      
      
      gauss_points_tr (gp1.a,gp2.a,w.a,intordsm[ii][jj]);
      ipp=Mt->elements[eid].ipp[ri+ii][ci+jj];

      for (i=0;i<intordsm[ii][jj];i++){
	jac_2d (jac,x,y,gp1[i],gp2[i]);
        jac*=w[i];
	
	Mm->storeipvol (ipp,jac);
	
        ipp++;
      }
      
      destrv (w);      destrv (gp1);      destrv (gp2);
    }
  }
  
  allocv (1,w);
  allocv (1,gp1);
  allocv (1,gp2);
  
  gauss_points_tr (gp1.a,gp2.a,w.a,1);
  
  jac_2d (jac,x,y,gp1[i],gp2[i]);
  jac*=w[i];
  
  Mm->storeipvol (ipp,jac);
  
  destrv (gp1);  destrv (gp2);  destrv (w);
}