Add quadratic solid internal force path

This commit is contained in:
shenw
2026-06-22 22:29:29 +08:00
parent 410d60ab9c
commit cd6c6ac4e4
3 changed files with 444 additions and 0 deletions
+197
View File
@@ -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