Add quadratic solid internal force path
This commit is contained in:
@@ -40,6 +40,9 @@ contains
|
||||
case ('C3D8')
|
||||
call c3d8_internal_force(elem, dt_local, ierr)
|
||||
if (ierr .ne. FEM_SUCCESS) return
|
||||
case ('C3D10', 'C3D20')
|
||||
call solid_quadratic_internal_force(elem, dt_local, ierr)
|
||||
if (ierr .ne. FEM_SUCCESS) return
|
||||
case ('S4')
|
||||
call shell4_internal_force(elem, ierr)
|
||||
if (ierr .ne. FEM_SUCCESS) return
|
||||
@@ -279,6 +282,115 @@ contains
|
||||
ierr = FEM_SUCCESS
|
||||
end subroutine c3d8_internal_force
|
||||
|
||||
subroutine solid_quadratic_internal_force(elem, dt, ierr)
|
||||
integer, intent(in) :: elem
|
||||
real(rk), intent(in) :: dt
|
||||
integer, intent(out) :: ierr
|
||||
integer, parameter :: MAX_QP = 32
|
||||
real(rk) :: gp_nat(NDIM,MAX_QP)
|
||||
real(rk) :: gp_weight(MAX_QP)
|
||||
real(rk) :: nshape(MAX_NEN)
|
||||
real(rk) :: dndr(NDIM,MAX_NEN)
|
||||
real(rk) :: dndx(NDIM,MAX_NEN)
|
||||
real(rk) :: detj
|
||||
real(rk) :: eps(NSTRESS)
|
||||
real(rk) :: deps(NSTRESS)
|
||||
real(rk) :: sig(NSTRESS)
|
||||
real(rk) :: state_old(NSTATEV_MAX)
|
||||
real(rk) :: state_new(NSTATEV_MAX)
|
||||
real(rk) :: stress_old(NSTRESS)
|
||||
real(rk) :: spin_current(3)
|
||||
real(rk) :: spin_inc(3)
|
||||
real(rk) :: local_force(NDIM,MAX_NEN)
|
||||
real(rk) :: factor
|
||||
integer :: q
|
||||
integer :: npoint
|
||||
integer :: nlocal
|
||||
integer :: local_node
|
||||
integer :: node
|
||||
integer :: gp
|
||||
integer :: gp_start
|
||||
integer :: failed_count
|
||||
integer :: dof
|
||||
|
||||
nlocal = elem_nnode(elem)
|
||||
call element_validate_node_count(elem_type(elem), nlocal, ierr)
|
||||
if (ierr .ne. FEM_SUCCESS) return
|
||||
|
||||
call quadrature_get_rule(elem_type(elem), MAX_QP, npoint, gp_nat, gp_weight, ierr)
|
||||
if (ierr .ne. FEM_SUCCESS) return
|
||||
|
||||
gp_start = elem_gp_start(elem)
|
||||
gp = gp_start
|
||||
failed_count = 0
|
||||
local_force = ZERO
|
||||
|
||||
do q = 1, npoint
|
||||
call shape_evaluate(elem_type(elem), gp_nat(:,q), nshape, dndr, ierr)
|
||||
if (ierr .ne. FEM_SUCCESS) return
|
||||
call solid_shape_gradients(elem, nlocal, dndr, dndx, detj, ierr)
|
||||
if (ierr .ne. FEM_SUCCESS) return
|
||||
|
||||
call solid_strain_from_dndx(elem, nlocal, dndx, eps)
|
||||
|
||||
deps = eps
|
||||
stress_old = ZERO
|
||||
state_old = ZERO
|
||||
if (gp .gt. 0) then
|
||||
deps = eps - strain(:,gp)
|
||||
stress_old = stress(:,gp)
|
||||
state_old = statev(:,gp)
|
||||
end if
|
||||
call solid_current_spin(elem, nlocal, dndx, spin_current)
|
||||
spin_inc = spin_current - state_old(14:16)
|
||||
|
||||
call material_update_small_strain_dt(elem_mat(elem), dt, deps, &
|
||||
state_old, stress_old, sig, &
|
||||
state_new, ierr, spin_inc)
|
||||
if (ierr .ne. FEM_SUCCESS) return
|
||||
state_new(14:16) = spin_current
|
||||
|
||||
if (gp .gt. 0) then
|
||||
strain(:,gp) = eps
|
||||
stress(:,gp) = sig
|
||||
statev(:,gp) = state_new
|
||||
if (state_new(4) .ge. HALF) failed_count = failed_count + 1
|
||||
end if
|
||||
|
||||
factor = gp_weight(q) * detj
|
||||
do local_node = 1, nlocal
|
||||
local_force(1,local_node) = local_force(1,local_node) + factor * &
|
||||
(dndx(1,local_node) * sig(1) + dndx(2,local_node) * sig(4) + &
|
||||
dndx(3,local_node) * sig(5))
|
||||
local_force(2,local_node) = local_force(2,local_node) + factor * &
|
||||
(dndx(1,local_node) * sig(4) + dndx(2,local_node) * sig(2) + &
|
||||
dndx(3,local_node) * sig(6))
|
||||
local_force(3,local_node) = local_force(3,local_node) + factor * &
|
||||
(dndx(1,local_node) * sig(5) + dndx(2,local_node) * sig(6) + &
|
||||
dndx(3,local_node) * sig(3))
|
||||
end do
|
||||
|
||||
gp = gp + 1
|
||||
end do
|
||||
|
||||
if (should_delete_solid(elem_type(elem), failed_count, npoint)) then
|
||||
elem_status(elem) = 1
|
||||
if (gp_start .gt. 0) stress(:,gp_start:gp_start+npoint-1) = ZERO
|
||||
else
|
||||
do local_node = 1, nlocal
|
||||
node = elem_conn(local_node, elem)
|
||||
dof = dof_id(1,node)
|
||||
if (dof .gt. 0) fint(dof) = fint(dof) + local_force(1,local_node)
|
||||
dof = dof_id(2,node)
|
||||
if (dof .gt. 0) fint(dof) = fint(dof) + local_force(2,local_node)
|
||||
dof = dof_id(3,node)
|
||||
if (dof .gt. 0) fint(dof) = fint(dof) + local_force(3,local_node)
|
||||
end do
|
||||
end if
|
||||
|
||||
ierr = FEM_SUCCESS
|
||||
end subroutine solid_quadratic_internal_force
|
||||
|
||||
subroutine shell4_internal_force(elem, ierr)
|
||||
integer, intent(in) :: elem
|
||||
integer, intent(out) :: ierr
|
||||
@@ -656,6 +768,91 @@ contains
|
||||
end do
|
||||
end subroutine shell4_add_global
|
||||
|
||||
subroutine solid_shape_gradients(elem, nlocal, dndr, dndx, detj, ierr)
|
||||
integer, intent(in) :: elem
|
||||
integer, intent(in) :: nlocal
|
||||
real(rk), intent(in) :: dndr(NDIM,MAX_NEN)
|
||||
real(rk), intent(out) :: dndx(NDIM,MAX_NEN)
|
||||
real(rk), intent(out) :: detj
|
||||
integer, intent(out) :: ierr
|
||||
real(rk) :: jac(NDIM,NDIM)
|
||||
real(rk) :: invj(NDIM,NDIM)
|
||||
integer :: local_node
|
||||
integer :: node
|
||||
integer :: i
|
||||
integer :: j
|
||||
integer :: k
|
||||
|
||||
jac = ZERO
|
||||
dndx = ZERO
|
||||
|
||||
do local_node = 1, nlocal
|
||||
node = elem_conn(local_node, elem)
|
||||
do i = 1, NDIM
|
||||
do j = 1, NDIM
|
||||
jac(i,j) = jac(i,j) + coord0(i,node) * dndr(j,local_node)
|
||||
end do
|
||||
end do
|
||||
end do
|
||||
|
||||
call inverse3(jac, invj, detj, ierr)
|
||||
if (ierr .ne. FEM_SUCCESS) return
|
||||
if (detj .le. ZERO) then
|
||||
call error_set(FEM_ERR_MESH, 'solid element has non-positive Jacobian', ierr)
|
||||
return
|
||||
end if
|
||||
|
||||
do local_node = 1, nlocal
|
||||
do i = 1, NDIM
|
||||
dndx(i,local_node) = ZERO
|
||||
do k = 1, NDIM
|
||||
dndx(i,local_node) = dndx(i,local_node) + invj(k,i) * dndr(k,local_node)
|
||||
end do
|
||||
end do
|
||||
end do
|
||||
|
||||
ierr = FEM_SUCCESS
|
||||
end subroutine solid_shape_gradients
|
||||
|
||||
subroutine solid_strain_from_dndx(elem, nlocal, dndx, eps)
|
||||
integer, intent(in) :: elem
|
||||
integer, intent(in) :: nlocal
|
||||
real(rk), intent(in) :: dndx(NDIM,MAX_NEN)
|
||||
real(rk), intent(out) :: eps(NSTRESS)
|
||||
integer :: local_node
|
||||
integer :: node
|
||||
|
||||
eps = ZERO
|
||||
do local_node = 1, nlocal
|
||||
node = elem_conn(local_node, elem)
|
||||
eps(1) = eps(1) + dndx(1,local_node) * get_dof_value(u, 1, node)
|
||||
eps(2) = eps(2) + dndx(2,local_node) * get_dof_value(u, 2, node)
|
||||
eps(3) = eps(3) + dndx(3,local_node) * get_dof_value(u, 3, node)
|
||||
eps(4) = eps(4) + dndx(2,local_node) * get_dof_value(u, 1, node) + &
|
||||
dndx(1,local_node) * get_dof_value(u, 2, node)
|
||||
eps(5) = eps(5) + dndx(3,local_node) * get_dof_value(u, 1, node) + &
|
||||
dndx(1,local_node) * get_dof_value(u, 3, node)
|
||||
eps(6) = eps(6) + dndx(3,local_node) * get_dof_value(u, 2, node) + &
|
||||
dndx(2,local_node) * get_dof_value(u, 3, node)
|
||||
end do
|
||||
end subroutine solid_strain_from_dndx
|
||||
|
||||
logical function should_delete_solid(etype, failed_count, npoint)
|
||||
character(len=*), intent(in) :: etype
|
||||
integer, intent(in) :: failed_count
|
||||
integer, intent(in) :: npoint
|
||||
character(len=ELEM_TYPE_LEN) :: local_type
|
||||
|
||||
local_type = adjustl(etype)
|
||||
if (failed_count .le. 0) then
|
||||
should_delete_solid = .false.
|
||||
else if (trim(local_type) .eq. 'C3D4' .or. trim(local_type) .eq. 'C3D10') then
|
||||
should_delete_solid = .true.
|
||||
else
|
||||
should_delete_solid = failed_count * 2 .ge. npoint
|
||||
end if
|
||||
end function should_delete_solid
|
||||
|
||||
subroutine solid_current_spin(elem, nlocal, dndx, spin_current)
|
||||
integer, intent(in) :: elem
|
||||
integer, intent(in) :: nlocal
|
||||
|
||||
Reference in New Issue
Block a user