barelq3d.cpp

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

/**
   function assembles natural coordinates of nodes of element

   @param xi - array containing natural coordinates xi

   JK, 29.9.2005
*/
void barelq3d::nodecoord (vector &xi)
{
  xi[0] = -1.0;
  xi[1] =  1.0;
  xi[2] =  0.0;
}


/**
   function returns numbers of integration point closest to element nodes
   
   @param eid - element id
   @param ri,ci - row and column indices
   @param ipnum - array of numbers
   
   JK, 29.9.2005
*/
void barelq3d::nodipnum (long eid,long ri,long ci,ivector &ipnum)
{
  long i;
  
  i=Mt->elements[eid].ipp[ri][ci];

  ipnum[0]=i;
  ipnum[1]=i+2;
  ipnum[2]=i+1;
}





/**
   function computes stresses at integration points
   
   @param lcid - load case id
   @param eid - element id
   
   JK
*/
void barelq3d::res_mainip_stresses (long lcid,long eid)
{
  mainip_stresses (lcid,eid,0,0);
}

/**
   function computes stresses at integration points of element
   
   @param lcid - load case id
   @param eid - element id
   @param ri - row index
   @param ci - column index

   JK, 29.9.2005
*/
void barelq3d::mainip_stresses (long lcid,long eid,long ri,long ci)
{
  long i,ii,jj,ipp;
  double xi;
  vector gp,w,eps,epst,epstt,sig,auxsig;
  matrix d(tncomp,tncomp);
  
  for (ii=0;ii<nb;ii++){
    
    allocv (ncomp[ii],sig);
    allocv (ncomp[ii],auxsig);
    allocv (intordsm[ii][ii],gp);
    allocv (intordsm[ii][ii],w);
    
    gauss_points (gp.a,w.a,intordsm[ii][ii]);
    ipp=Mt->elements[eid].ipp[ri+ii][ci+ii];
    
    for (i=0;i<intordsm[ii][ii];i++){
      xi=gp[i];
      
      Mm->matstiff (d,ipp);
      
      fillv (0.0,sig);
      for (jj=0;jj<nb;jj++){
	allocv (ncomp[jj],eps);
	
	//  block of strains
	Mm->givestrain (lcid,ipp,cncomp[jj],ncomp[jj],eps);
	
	//  stress contributions
	mxv (d,eps,auxsig);
	//  summation of contributions
	addv (auxsig,sig,sig);
	
	destrv (eps);
      }
      
      //  storage of block of stress
      Mm->storestress (lcid,ipp,cncomp[ii],ncomp[ii],sig);
      
      ipp++;
    }
    
    destrv (w);  destrv (gp);  destrv (auxsig);  destrv (sig);
  }
}


/**
   function computes stresses at nodes of element

   @param lcid - load case id
   @param eid - element id
   @param ri,ci - row and column indices
   
   JK, 29.9.2005
*/
void barelq3d::nod_stresses_ip (long lcid,long eid,long ri,long ci)
{
  long i,j;
  ivector ipnum(nne),nod(nne);
  vector sig(tncomp);
  
  //  numbers of integration points closest to nodes
  nodipnum (eid,ri,ci,ipnum);
  
  //  node numbers of the element
  Mt->give_elemnodes (eid,nod);
  
  for (i=0;i<nne;i++){
    //  stresses at the closest integration point
    Mm->givestress (lcid,ipnum[i],sig);
    
    //  storage of stresses to the node
    j=nod[i];
    Mt->nodes[j].storestress (lcid,0,sig);
  }
  
}

/**
   function computes nodal stresses directly
   
   @param lcid - load case id
   @param eid - element id
   @param ri,ci - row and column indices
   @param stra - array for strain components
   @param stre - array for stress components
   
   JK, 25.9.2004
*/
void barelq3d::nod_stresses_comp (long lcid,long eid,long ri,long ci,double **stra,double **stre)
{
  long i,j,ipp;
  vector eps(tncomp),sig(tncomp);
  matrix d(tncomp,tncomp);
  
  //  number of the first integration point on the element
  ipp=Mt->elements[eid].ipp[ri][ci];
  //  stiffness matrix of the material
  Mm->matstiff (d,ipp);
  
  //  loop over nodes
  for (i=0;i<nne;i++){
    for (j=0;j<eps.n;j++){
      eps[j]=stra[i][j];
    }
    mxv (d,eps,sig);
    for (j=0;j<eps.n;j++){
      stre[i][j]=sig[j];
    }
  }
}

/**
   function computes all stress components at all integration points
   
   @param lcid - load case id
   @param eid - element id
   
   JK
*/
void barelq3d::res_allip_stresses (long lcid,long eid)
{
  //  all stress components at all intergation points
  allip_stresses (lcid,eid,0,0);
}

/**
   function computes all stress components at all integration points
   
   @param lcid - load case id
   @param eid - element id
   @param ri,ci - row and column indices
   
   JK
*/
void barelq3d::allip_stresses (long lcid,long eid,long ri,long ci)
{
  //  blocks of stress components at integration points
  res_mainip_stresses (lcid,eid);
}



void barelq3d::stresses (long lcid,long eid,long ri,long ci)
{
  vector coord,sig;

  switch (Mm->stre.tape[eid]){
  case nowhere:{
    break;
  }
  case intpts:{
    allip_stresses (lcid,eid,ri,ci);
    break;
  }
  case enodes:{
    nod_stresses_ip (lcid,eid,ri,ci);
    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 (1,coord);
    for (i=0;i<naep;i++){
      Mm->stre.give_aepcoord (sid,i,coord);

      if (Mp->stressaver==0)
	//appval (coord[0],0,ncp,sig,stre);
      if (Mp->stressaver==1)
	//appstress (lcid,eid,coord[0],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 barelq3d::stresses (file %s, line %d).\n",__FILE__,__LINE__);
  }
  }

}






/**
   function computes other values in nodes of element

   @param lcid - load case id
   @param eid - element id
   
   10.5.2002
*/
void barelq3d::nod_eqother_ip (long lcid,long eid,long ri,long ci)
{
  long i,j,ncompo;
  ivector ipnum(nne),nod(nne);
  vector eqother;
  
  //  numbers of integration points closest to nodes
  nodipnum (eid,ri,ci,ipnum);
  
  //  node numbers of the element
  Mt->give_elemnodes (eid,nod);
  
  for (i=0;i<nne;i++){
    //  strains at the closest integration point
    //Mm->givestrain (lcid,ipnum[i],eps);
    
    ncompo = Mm->givencompeqother (ipnum[i],0);
    allocv (ncompo,eqother);
    Mm->giveeqother (ipnum[i],0,ncompo,eqother.a);
    
    //  storage of other values to the node
    j=nod[i];
    Mt->nodes[j].storeother (lcid,0,ncompo,eqother);
    
    destrv (eqother);
  }
}






/**

   load vector is obtained after premultiplying load %matrix
   by nodal load values
   
   @param eid - number of element
   @param lm - load %matrix
   
   JK, 12.4.2003
*/
void barelq3d::load_matrix (long eid,matrix &lm)
{
  /*
  long i;
  double jac,xi,area;
  ivector nodes(nne);
  vector x(nne),y(nne),w(intordmm),gp(intordmm);
  matrix n(napfun,ndofe);
  
  Mt->give_elemnodes (eid,nodes);
  Mc->give_area (eid,area);

  Mt->give_node_coord2d (x,y,eid);
  

  gauss_points (gp.a,w.a,intordmm);
  
  fillm (0.0,lm);

  for (i=0;i<intordmm;i++){
    xi=gp[i];
    
    jac_1d (jac,x,xi);
    bf_matrix (n,xi);
    
    jac*=w[i]*area;
    
    nnj (lm.a,n.a,jac,n.m,n.n);
  }
  */
}

void barelq3d::res_eigstrain_forces (long lcid,long eid,vector &nfor)
{
  vector gx(nne),gy(nne),gz(nne),x(nne),s(3);
  
  //  nodal coordinates in global system
  Mt->give_node_coord3d (gx,gy,gz,eid);
  //  computation of x coodinates in local system attached to the bar
  giveloccoord (gx,gy,gz,x);
  //  computation of direction vector
  dirvect (s,gx,gy,gz);
  
  eigstrain_forces (lcid,eid,0,0,nfor,x,s);
}

/**
   function computes nodal forces caused by eigenstrains
   function is used for nodal forces caused by temperature
   
   @param lcid - load case id
   @param eid - element id
   @param ri,ci - row and column indices
   @param nfor - array containing nodal forces
   @param x - nodal coordinates
   @param s - direction %vector
   
   JK, 29.9.2005
*/
void barelq3d::eigstrain_forces (long lcid,long eid,long ri,long ci,vector &nfor,vector &x,vector &s)
{
  long i,k,ii,ipp;
  double xi,area,jac;
  ivector nodes(nne);
  vector sig,contr(ndofe),gp,w,eigstr;
  matrix d(tncomp,tncomp),gm;
  
  Mt->give_elemnodes (eid,nodes);
  Mc->give_area (eid,area);
  
  fillv (0.0,nfor);

  for (ii=0;ii<nb;ii++){
    
    allocv (intordsm[ii][ii],w);
    allocv (intordsm[ii][ii],gp);
    
    allocm (ncomp[ii],ndofe,gm);
    allocv (ncomp[ii],eigstr);
    allocv (ncomp[ii],sig);
    
    gauss_points (gp.a,w.a,intordsm[ii][ii]);
    
    ipp=Mt->elements[eid].ipp[ri+ii][ci+ii];
    for (i=0;i<intordsm[ii][ii];i++){
      xi=gp[i];
      
      Mm->giveeigstrain (ipp,cncomp[ii],ncomp[ii],eigstr);
      
      Mm->matstiff (d,ipp);
      mxv (d,eigstr,sig);
      geom_matrix (gm,x,s,xi,jac);
      mtxv (gm,sig,contr);
      cmulv (jac*w[i]*area,contr);
      
      for (k=0;k<contr.n;k++){
	nfor[k]+=contr[k];
      }

      ipp++;
    }
    destrv (sig);  destrv (eigstr);  destrv (gp);  destrv (w);
    destrm (gm);
  }
}










/**
   function computes internal forces

   @param lcid - load case id
   @param eid - element id
   @param ri,ci - row and column indices
   @param ifor - vector of internal forces
   @param x - x-coordinates in local system
   @param s - direction %vector
   
   12.8.2001
*/
void barelq3d::internal_forces (long lcid,long eid,long ri,long ci,vector &ifor,vector &x,vector &s)
{
  long i,k,ii,ipp;
  double xi,jac,area;
  vector w,gp,eps(tncomp),sig,contr(ndofe);
  matrix gm;
  
  
  Mc->give_area (eid,area);
  
  fillv (0.0,ifor);
  
  for (ii=0;ii<nb;ii++){
    allocv (intordsm[ii][ii],gp);
    allocv (intordsm[ii][ii],w);
    allocm (ncomp[ii],ndofe,gm);
    allocv (ncomp[ii],sig);
    
    gauss_points (gp.a,w.a,intordsm[ii][ii]);
    ipp=Mt->elements[eid].ipp[ri+ii][ci+ii];
    
    for (i=0;i<intordsm[ii][ii];i++){
      xi=gp[i];
      
      if (Mp->strcomp==1)
	Mm->computenlstresses (ipp);
      
      Mm->givestress (lcid,ipp,cncomp[ii],sig);
      geom_matrix (gm,x,s,xi,jac);
      mtxv (gm,sig,contr);
      
      cmulv (jac*w[i]*area,contr);
      
      for (k=0;k<contr.n;k++){
	ifor[k]+=contr[k];
      }
      
      ipp++;
    }
  }
  destrv (sig);  destrm (gm);  destrv (w);  destrv (gp);
  
}

/**
   function computes resulting internal forces

   @param lcid - load case id
   @param eid - element id
   @param ifor - vector of internal forces

   JK, 29.9.2005
*/
void barelq3d::res_internal_forces (long lcid,long eid,vector &ifor)
{
  vector gx(nne),gy(nne),gz(nne),x(nne),s(3);

  //  nodal coordinates in global system
  Mt->give_node_coord3d (gx,gy,gz,eid);
  //  computation of x coodinates in local system attached to the bar
  giveloccoord (gx,gy,gz,x);
  //  computation of direction vector
  dirvect (s,gx,gy,gz);

  internal_forces (lcid,eid,0,0,ifor,x,s);
}



void barelq3d::res_mass_matrix (long eid,matrix &sm)
{
  vector gx(nne),gy(nne),gz(nne),x(nne);
  Mt->give_node_coord2d (gx,gy,eid);
  
  giveloccoord (gx,gy,gz,x);
  // mass_matrix ();
}



void barelq3d::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, ipval;
  vector w, gp, anv(3);

  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],gp);
        allocv (intordsm[ii][jj],w);
        gauss_points (gp.a,w.a,intordsm[ii][jj]);
        for (k = 0; k < intordsm[ii][jj]; k++)
        {
          xi=gp[k];
          //  value in integration point
          ipval = approx (xi,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 (gp);  destrv (w);
      }
    }
    if (ictn[i] & inistrain) nstra++;
  }
}


void barelq3d::intpointval (long eid,vector &nodval,vector &ipval)
{
  long ii,jj,i,k,ipp;
  double xi;
  vector w,gp;

  k=0;
  for (ii = 0; ii < nb; ii++)
  {
    for (jj = 0; jj < nb; jj++)
    {
      ipp=Mt->elements[eid].ipp[ii][jj];
      if (intordsm[ii][jj] == 0)
        continue;
      allocv (intordsm[ii][jj],gp);
      allocv (intordsm[ii][jj],w);
      gauss_points (gp.a,w.a,intordsm[ii][jj]);
      for (i = 0; i < intordsm[ii][jj]; i++)
      {
        xi=gp[i];
        //  value in integration point
        ipval[k] = approx (xi,nodval);
        k++;
        ipp++;
      }
      destrv (gp);  destrv (w);
    }
  }
}

void barelq3d::intpointval2 (long eid,vector &nodval,vector &ipval)
{
  long ii,jj,i,k;
  double xi;
  vector w,gp;
  vector modnodval(Bar2d->nne);
  
  for (i=0;i<Bar2d->nne;i++){
    modnodval[i]=nodval[i];
  }

  k=0;
  for (ii = 0; ii < nb; ii++){
    for (jj = 0; jj < nb; jj++){
      if (intordsm[ii][jj] == 0)
        continue;

      allocv (intordsm[ii][jj],gp);
      allocv (intordsm[ii][jj],w);

      gauss_points (gp.a,w.a,intordsm[ii][jj]);

      for (i = 0; i < intordsm[ii][jj]; i++){
        xi=gp[i];

        //  value in integration point
        ipval[k] = Bar2d->approx (xi,modnodval);

        k++;
      }
      destrv (gp);  destrv (w);
    }
  }
}