fstr_contact_elem_alag.f90

Go to the documentation of this file.

!-------------------------------------------------------------------------------
! Copyright (c) 2019 FrontISTR Commons
! This software is released under the MIT License, see LICENSE.txt
!-------------------------------------------------------------------------------
module m_fstr_contact_elem_alag
  use hecmw
  use elementinfo
  use mcontactdef
  use msurfelement
  use m_fstr_contact_geom
  use m_fstr_contact_elem_common
  implicit none
 
  public :: getcontactstiffness_alag
  public :: getcontactnodalforce_alag
  public :: gettiedstiffness_alag
  public :: gettiednodalforce_alag
  public :: updatecontactmultiplier_alag
 
contains
 
  subroutine getcontactstiffness_alag(cstate, tSurf, ele, mu, mut, fcoeff, symm, stiff, force)
 
    type(tcontactstate), intent(inout) :: cstate
    type(tsurfelement), intent(in)  :: tsurf
    real(kind=kreal), intent(in)    :: ele(:,:)        
    real(kind=kreal), intent(in)    :: mu, mut         
    real(kind=kreal), intent(in)    :: fcoeff          
    logical, intent(in)             :: symm
    real(kind=kreal), intent(out)   :: stiff(:,:)      
    real(kind=kreal), intent(out)   :: force(:)        
 
    integer          :: i, j, nnode
    real(kind=kreal) :: bn(size(tsurf%nodes)*3+3), ht(2,size(tsurf%nodes)*3+3), gt(2,size(tsurf%nodes)*3+3)
    real(kind=kreal) :: metric(2,2)
    real(kind=kreal) :: a(2,2)       
    real(kind=kreal) :: norm_trial, alpha_proj, that(2)
    real(kind=kreal) :: k_fric(size(tsurf%nodes)*3+3,size(tsurf%nodes)*3+3)  
    real(kind=kreal) :: hta(2,size(tsurf%nodes)*3+3), tmp_vec(2)
    real(kind=kreal) :: dummy_force(size(tsurf%nodes)*3+3)  
    real(kind=kreal) :: zero_disp(size(tsurf%nodes)*3+3)   
 
    nnode = size(tsurf%nodes)
 
    ! Use common mapping routine to compute Bn, metric, Ht, Gt
    call computecontactmaps_alag(cstate, tsurf, ele, bn, metric, ht, gt)
 
    ! Normal stiffness: stiff = mu * Bn * Bn^T
    do j = 1, nnode*3+3
      do i = 1, nnode*3+3
        stiff(i,j) = mu * bn(i) * bn(j)
      enddo
    enddo
    force(1:nnode*3+3) = bn(:)
 
    ! frictional component
    if( fcoeff /= 0.d0 ) then
      ! Compute trial friction info for consistent tangent
      ! Use zero displacement to get projection parameters from current multiplier state
      zero_disp = 0.0d0  ! zero displacement increment
      call computefrictionforce_alag(cstate, fcoeff, cstate%multiplier(1), metric, &
                                      ht, gt, zero_disp, nnode*3+3, dummy_force, &
                                      mut, norm_trial=norm_trial, alpha=alpha_proj, that=that)
 
      ! Construct 2D local tangent operator A
      if( cstate%multiplier(1) <= 0.0d0 .or. alpha_proj <= 1.0d-20 ) then
        ! No friction: A = 0
        a = 0.0d0
      else if( alpha_proj >= 0.999d0 .or. norm_trial < 1.0d-20 ) then
        ! Stick: A = mut*I
        a(1,1) = mut
        a(2,2) = mut
        a(1,2) = 0.0d0
        a(2,1) = 0.0d0
      else
        ! Slip: A = alpha*mut*(I - that⊗that)
        a(1,1) = alpha_proj * mut * (1.0d0 - that(1)*that(1))
        a(1,2) = alpha_proj * mut * (-that(1)*that(2))
        a(2,1) = alpha_proj * mut * (-that(2)*that(1))
        a(2,2) = alpha_proj * mut * (1.0d0 - that(2)*that(2))
      endif
 
      ! Compute friction stiffness: K_fric = Ht^T * A * Gt
      ! First: HtA = A^T * Ht (2 x edof)
      hta(1:2,1:nnode*3+3) = matmul(transpose(a), ht(1:2,1:nnode*3+3))
      ! Then: K_fric = Ht^T * HtA = Ht^T * A^T * Ht (but we want Ht^T * A * Gt)
      ! Correct: K_fric(i,j) = Ht(:,i)^T * A * Gt(:,j)
      do j = 1, nnode*3+3
        tmp_vec = matmul(a, gt(1:2,j))
        do i = 1, nnode*3+3
          k_fric(i,j) = dot_product(ht(1:2,i), tmp_vec)
        enddo
      enddo
 
      stiff(1:nnode*3+3,1:nnode*3+3) = stiff(1:nnode*3+3,1:nnode*3+3) + k_fric(1:nnode*3+3,1:nnode*3+3)
    endif
 
  end subroutine getcontactstiffness_alag
 
  subroutine getcontactnodalforce_alag(ctState,tSurf,ndCoord,ndDu,mu,mut,fcoeff,lagrange,ctNForce,ctTForce,cflag)
 
    use msurfelement
    type(tcontactstate) :: ctstate
    type(tsurfelement)  :: tsurf
    integer(kind=kint) :: nnode
    integer(kind=kint) :: j
    real(kind=kreal), intent(in) :: mu, mut 
    real(kind=kreal)   :: fcoeff 
    real(kind=kreal)   :: lagrange 
    real(kind=kreal)   :: ndcoord(:), nddu(:) 
    real(kind=kreal)   :: ctnforce(:) 
    real(kind=kreal)   :: cttforce(:) 
    logical            :: cflag
 
    real(kind=kreal)   :: normal(3) 
    real(kind=kreal)   :: bn(3*l_max_elem_node+3) 
    real(kind=kreal)   :: ht(2,3*l_max_elem_node+3), gt(2,3*l_max_elem_node+3) 
    real(kind=kreal)   :: elemcrd(3, l_max_elem_node) 
    real(kind=kreal)   :: edisp(3*l_max_elem_node+3) 
    real(kind=kreal)   :: dgn, nrlforce 
    real(kind=kreal)   :: metric(2,2)
    integer(kind=kint) :: edof
 
    nnode = size(tsurf%nodes)
    edof = nnode*3+3
 
    ctnforce = 0.0d0
    cttforce = 0.0d0
 
    normal(1:3) = ctstate%direction(1:3)
 
    ! Prepare elemcrd = ndCoord - ndDu (i.e., coord + disp) for computeContactMaps_ALag
    do j = 1, nnode
      elemcrd(1:3, j) = ndcoord(j*3+1:j*3+3) - nddu(j*3+1:j*3+3)
    enddo
 
    ! Use common mapping routine to compute Bn, metric, Ht, Gt
    call computecontactmaps_alag(ctstate, tsurf, elemcrd(:,1:nnode), &
                                  bn, metric, ht, gt)
 
    ! Normal gap: dgn = Bn^T * ndCoord (using normal distribution vector)
    dgn = dot_product( bn(1:edof), ndcoord(1:edof) )
 
    ! Normal force: multiplier + penalty * gap
    nrlforce = ctstate%multiplier(1) + mu*dgn
 
    ! Distribute normal force using Bn: ctNForce = -nrlforce * Bn
    ctnforce(1:edof) = -nrlforce * bn(1:edof)
 
    ! Lagrange row (not used in ALagrange, set to 0)
    ctnforce((nnode+1)*3+1) = 0.d0
 
    if( fcoeff == 0.d0 ) return
 
    ! --- Tangent component ---
 
    ! Prepare edisp from ndDu
    edisp(1:3) = nddu(1:3)  ! slave
    do j = 1, nnode
      edisp(j*3+1:j*3+3) = nddu(j*3+1:j*3+3)  ! master nodes
    enddo
 
    ! Compute friction force using common routine
    call computefrictionforce_alag(ctstate, fcoeff, ctstate%multiplier(1), metric, &
                                    ht, gt, edisp, edof, cttforce, &
                                    mut)
 
    ! Lagrange row (not used in ALagrange, set to 0)
    cttforce((nnode+1)*3+1) = 0.d0
 
  end subroutine getcontactnodalforce_alag
 
  subroutine updatecontactmultiplier_alag(ctState,ndLocal,coord,disp,ddisp,&
     &  mu,mut,fcoeff,etype,lgnt,ctchanged,ctNForce,ctTForce,jump_ratio)
 
    type(tcontactstate), intent(inout)   :: ctstate
    integer(kind=kint), intent(in)       :: ndlocal(:)
    real(kind=kreal), intent(in)         :: coord(:)            
    real(kind=kreal), intent(in)         :: disp(:)             
    real(kind=kreal), intent(in)         :: ddisp(:)            
    real(kind=kreal), intent(in)         :: mu, mut             
    real(kind=kreal), intent(in)         :: fcoeff              
    integer(kind=kint), intent(in)       :: etype
    real(kind=kreal), intent(inout)      :: lgnt(2)             
    logical, intent(inout)               :: ctchanged
    real(kind=kreal), intent(out)        :: ctnforce(:)         
    real(kind=kreal), intent(out)        :: cttforce(:)         
    real(kind=kreal), intent(out)        :: jump_ratio          
 
    integer(kind=kint)  :: nnode
    integer(kind=kint)  :: slave, j
    real(kind=kreal)    :: bn(3*l_max_elem_node+3) 
    real(kind=kreal)    :: ht(2,3*l_max_elem_node+3), gt(2,3*l_max_elem_node+3) 
    real(kind=kreal)    :: elemcrd(3,l_max_elem_node) 
    real(kind=kreal)    :: curpos(3*l_max_elem_node+3) 
    real(kind=kreal)    :: edisp(3*l_max_elem_node+3) 
    real(kind=kreal)    :: dgn, nrlforce 
    real(kind=kreal)    :: metric(2,2)
    real(kind=kreal)    :: dxy(2)        
    integer(kind=kint)  :: edof
    type(tsurfelement)  :: tsurf_tmp
 
    nnode = size(ndlocal) - 1
    slave = ndlocal(1)
    edof = nnode*3+3
 
    ctnforce = 0.0d0
    cttforce = 0.0d0
 
    ! Prepare elemcrd (coord+disp) and current positions (coord+disp+ddisp)
    curpos(1:3) = coord(3*slave-2:3*slave) + disp(3*slave-2:3*slave) + ddisp(3*slave-2:3*slave)
    edisp(1:3) = ddisp(3*slave-2:3*slave)
    do j = 1, nnode
      elemcrd(1:3,j) = coord(3*ndlocal(j+1)-2:3*ndlocal(j+1)) + disp(3*ndlocal(j+1)-2:3*ndlocal(j+1))
      curpos(j*3+1:j*3+3) = elemcrd(1:3,j) + ddisp(3*ndlocal(j+1)-2:3*ndlocal(j+1))
      edisp(j*3+1:j*3+3) = ddisp(3*ndlocal(j+1)-2:3*ndlocal(j+1))
    enddo
 
    ! Build temporary tSurf for computeContactMaps_ALag
    allocate(tsurf_tmp%nodes(nnode))
    tsurf_tmp%etype = etype
    tsurf_tmp%nodes = ndlocal(2:nnode+1)
 
    ! Use common mapping routine to compute Bn, metric, Ht, Gt
    call computecontactmaps_alag(ctstate, tsurf_tmp, elemcrd(:,1:nnode), &
                                  bn, metric, ht, gt)
 
    ! Normal gap: dgn = Bn^T * curpos (using normal distribution vector)
    dgn = dot_product( bn(1:edof), curpos(1:edof) )
 
    ! Update multiplier and working distance
    ctstate%wkdist = -dgn
    ctstate%multiplier(1) = ctstate%multiplier(1) - mu*ctstate%wkdist
    ctstate%distance = ctstate%wkdist
    lgnt(1) = lgnt(1) - ctstate%wkdist
 
    ! Normal force: use updated multiplier
    nrlforce = ctstate%multiplier(1)
 
    ! Distribute normal force using Bn: ctNForce = -nrlforce * Bn
    ctnforce(1:edof) = -nrlforce * bn(1:edof)
 
    if( fcoeff == 0.d0 ) return
 
    ! --- Tangent component ---
 
    ! Compute friction force with multiplier update and state check
    call computefrictionforce_alag(ctstate, fcoeff, ctstate%multiplier(1), metric, &
                                    ht, gt, edisp, edof, cttforce, &
                                    mut, &
                                    update_multiplier=.true., slave_id=slave, ctchanged=ctchanged, &
                                    jump_ratio=jump_ratio)
 
    ! Tangent displacement for convergence check: use Gt to project curpos directly
    dxy = matmul( gt(:,1:edof), curpos(1:edof) )
    lgnt(2) = lgnt(2) + dsqrt( dxy(1)*dxy(1) + dxy(2)*dxy(2) )
 
    ! Clean up temporary surface element
    deallocate(tsurf_tmp%nodes)
 
  end subroutine updatecontactmultiplier_alag
 
  subroutine gettiedstiffness_alag(cstate, tSurf, mu, stiff, force)
 
    type(tcontactstate), intent(in) :: cstate
    type(tsurfelement), intent(in)  :: tsurf
    real(kind=kreal), intent(in)    :: mu              
    real(kind=kreal), intent(out)   :: stiff(:,:)      
    real(kind=kreal), intent(out)   :: force(:)        
 
    integer          :: i, j, nnode, edof
    real(kind=kreal) :: tm(3, 3*(l_max_surface_node+1))
    real(kind=kreal) :: tt(3, 3*(l_max_surface_node+1))  
 
    nnode = size(tsurf%nodes)
    edof = nnode*3+3
 
    stiff = 0.d0
 
    ! Use common mapping routine to compute Tm
    call computetm_tt(cstate, tsurf, 0.0d0, tm, tt)
 
    ! Tied stiffness: stiff = mu * Tm^T * Tm
    do j = 1, edof
      do i = 1, edof
        stiff(i,j) = mu * dot_product(tm(1:3,i), tm(1:3,j))
      enddo
    enddo
    force(1:edof) = 0.d0  ! not used for tied (3-direction constraint)
 
  end subroutine gettiedstiffness_alag
 
  subroutine gettiednodalforce_alag(ctState,tSurf,ndu,mu,ctNForce,ctTForce)
 
    use msurfelement
    type(tcontactstate) :: ctstate
    type(tsurfelement)  :: tsurf
    integer(kind=kint)  :: nnode
    real(kind=kreal)   :: ndu(:) 
    real(kind=kreal), intent(in) :: mu 
    real(kind=kreal)   :: ctnforce(:)  
    real(kind=kreal)   :: cttforce(:)  
 
    integer(kind=kint) :: edof
    real(kind=kreal)   :: tm(3, 3*(l_max_surface_node+1))  
    real(kind=kreal)   :: tt(3, 3*(l_max_surface_node+1))  
    real(kind=kreal)   :: dg(3) 
    real(kind=kreal)   :: nrlforce(3) 
 
    nnode = size(tsurf%nodes)
    edof = nnode*3+3
 
    ctnforce = 0.0d0
    cttforce = 0.0d0
 
    ! Use common mapping routine to compute Tm
    call computetm_tt(ctstate, tsurf, 0.0d0, tm, tt)
 
    ! Gap vector: dg = Tm * ndu (3-component relative displacement)
    dg(1:3) = matmul(tm(1:3, 1:edof), ndu(1:edof))
 
    ! Force: multiplier + penalty * gap (3 components)
    nrlforce(1:3) = ctstate%multiplier(1:3) + mu*dg(1:3)
 
    ! Distribute force: ctNForce = -Tm^T * nrlforce
    ctnforce(1:edof) = -matmul(transpose(tm(1:3, 1:edof)), nrlforce(1:3))
 
    ! Lagrange row (not used in ALagrange, set to 0)
    ctnforce((nnode+1)*3+1) = 0.d0
    cttforce((nnode+1)*3+1) = 0.d0
 
  end subroutine gettiednodalforce_alag
 
end module m_fstr_contact_elem_alag