Files
FemLite/tests/module/test_solver_implicit.f90
shenw 62f1293a9f
FemLite CI / build-test (push) Has been cancelled
Complete V4.5 convergence diagnostics
2026-06-25 09:33:20 +08:00

603 lines
17 KiB
Fortran

program test_solver_implicit
use fem_precision
use fem_error
use fem_control
use fem_database
use fem_boundary
use fem_element_mass
use fem_solver_implicit
implicit none
real(rk), parameter :: TOL = 1.0e-10_rk
call check_single_dof_pull()
call check_prescribed_value()
call check_robin_explicit_force()
call check_robin_implicit_spring()
call check_mpc_explicit_force()
call check_mpc_implicit_penalty()
call check_newmark_mass_damping()
call check_newmark_nonlinear_elastic()
call check_newmark_nonlinear_robin()
call check_newmark_nonlinear_mpc()
call check_newmark_nonlinear_contact()
call check_newmark_trial_rollback()
call check_static_cutback_rollback()
contains
subroutine check_single_dof_pull()
integer :: ierr
integer :: iter
real(rk) :: res_norm
real(rk) :: expected
integer :: dof
call setup_pull_model(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(1)
call implicit_solve_linear_static(ZERO, 50, 1.0e-12_rk, iter, res_norm, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(2)
if (iter .le. 0 .or. iter .gt. 5) call fail(3)
if (res_norm .gt. TOL) call fail(4)
dof = dof_id(1,2)
expected = 5.0_rk / 6.0_rk
call check_close(u(dof), expected, 5)
call check_close(u(dof_id(2,2)), ZERO, 6)
call check_close(u(dof_id(3,2)), ZERO, 7)
call check_close(maxval(abs(v)), ZERO, 8)
call check_close(maxval(abs(a)), ZERO, 9)
call database_finalize(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(10)
end subroutine check_single_dof_pull
subroutine check_prescribed_value()
integer :: ierr
integer :: iter
real(rk) :: res_norm
integer :: dof
call setup_prescribed_model(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(20)
call implicit_solve_linear_static(ZERO, 50, 1.0e-12_rk, iter, res_norm, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(21)
if (res_norm .gt. TOL) call fail(22)
dof = dof_id(1,2)
call check_close(u(dof), 0.25_rk, 23)
call check_close(maxval(abs(v)), ZERO, 24)
call check_close(maxval(abs(a)), ZERO, 25)
call database_finalize(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(26)
end subroutine check_prescribed_value
subroutine check_robin_explicit_force()
integer :: ierr
integer :: dof
call setup_base_tet(0, 0, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(30)
call database_allocate_robin(1, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(31)
robin_target(1) = '2'
robin_dof(1) = 1
robin_stiffness(1) = 10.0_rk
robin_damping(1) = 2.0_rk
robin_reference(1) = 0.25_rk
robin_amp(1) = 0
dof = dof_id(1,2)
u(dof) = 0.5_rk
v(dof) = -0.1_rk
fext = ZERO
call boundary_apply_robin_forces(ZERO, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(32)
call check_close(fext(dof), -2.3_rk, 33)
call database_finalize(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(34)
end subroutine check_robin_explicit_force
subroutine check_robin_implicit_spring()
integer :: ierr
integer :: iter
real(rk) :: res_norm
integer :: dof
call setup_pull_model(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(40)
call database_allocate_robin(1, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(41)
robin_target(1) = '2'
robin_dof(1) = 1
robin_stiffness(1) = 6.0_rk
robin_damping(1) = ZERO
robin_reference(1) = 0.25_rk
robin_amp(1) = 0
call implicit_solve_linear_static(ZERO, 50, 1.0e-12_rk, iter, res_norm, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(42)
if (res_norm .gt. TOL) call fail(43)
dof = dof_id(1,2)
call check_close(u(dof), 13.0_rk / 24.0_rk, 44)
call check_close(u(dof_id(2,2)), ZERO, 45)
call check_close(u(dof_id(3,2)), ZERO, 46)
call database_finalize(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(47)
end subroutine check_robin_implicit_spring
subroutine check_mpc_explicit_force()
integer :: ierr
integer :: dof2
integer :: dof3
call setup_base_tet(0, 0, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(50)
call database_allocate_mpc(1, 2, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(51)
mpc_start(1) = 1
mpc_count(1) = 2
mpc_rhs(1) = 0.05_rk
mpc_penalty(1) = 10.0_rk
mpc_node(1) = 2
mpc_dof(1) = 1
mpc_coeff(1) = ONE
mpc_node(2) = 3
mpc_dof(2) = 1
mpc_coeff(2) = -2.0_rk
dof2 = dof_id(1,2)
dof3 = dof_id(1,3)
u(dof2) = 0.4_rk
u(dof3) = 0.1_rk
fext = ZERO
call boundary_apply_mpc_forces(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(52)
call check_close(fext(dof2), -1.5_rk, 53)
call check_close(fext(dof3), 3.0_rk, 54)
call database_finalize(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(55)
end subroutine check_mpc_explicit_force
subroutine check_mpc_implicit_penalty()
integer :: ierr
integer :: iter
real(rk) :: res_norm
integer :: dof
call setup_single_free_dof_model(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(60)
call database_allocate_mpc(1, 1, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(61)
mpc_start(1) = 1
mpc_count(1) = 1
mpc_rhs(1) = 0.25_rk
mpc_penalty(1) = 6.0_rk
mpc_node(1) = 2
mpc_dof(1) = 1
mpc_coeff(1) = ONE
call implicit_solve_linear_static(ZERO, 50, 1.0e-12_rk, iter, res_norm, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(62)
if (res_norm .gt. TOL) call fail(63)
dof = dof_id(1,2)
call check_close(u(dof), 0.125_rk, 64)
call check_close(u(dof_id(2,2)), ZERO, 65)
call check_close(u(dof_id(3,2)), ZERO, 66)
call database_finalize(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(67)
end subroutine check_mpc_implicit_penalty
subroutine check_newmark_mass_damping()
integer :: ierr
integer :: iter
integer :: dof
real(rk) :: res_norm
call setup_pull_model(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(70)
call element_compute_lumped_mass(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(71)
current_time = ZERO
rayleigh_alpha_mass = 2.0_rk
rayleigh_beta_stiffness = ZERO
call implicit_advance_newmark_linear(0.1_rk, 0.25_rk, 0.5_rk, &
50, 1.0e-12_rk, iter, res_norm, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(72)
if (iter .le. 0 .or. iter .gt. 5) call fail(73)
if (res_norm .gt. TOL) call fail(74)
dof = dof_id(1,2)
call check_close(u(dof), 15.0_rk / 73.0_rk, 75)
call check_close(v(dof), 300.0_rk / 73.0_rk, 76)
call check_close(a(dof), 6000.0_rk / 73.0_rk, 77)
call check_close(u(dof_id(2,2)), ZERO, 78)
call check_close(u(dof_id(3,2)), ZERO, 79)
rayleigh_alpha_mass = ZERO
rayleigh_beta_stiffness = ZERO
call database_finalize(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(80)
end subroutine check_newmark_mass_damping
subroutine check_newmark_nonlinear_elastic()
integer :: ierr
integer :: iter
integer :: dof
real(rk) :: res_norm
call setup_pull_model(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(90)
call element_compute_lumped_mass(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(91)
current_time = ZERO
rayleigh_alpha_mass = ZERO
rayleigh_beta_stiffness = ZERO
call implicit_newmark_nonlinear_step(0.1_rk, 0.25_rk, 0.5_rk, &
50, 1.0e-12_rk, iter, res_norm, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(92)
if (iter .le. 0 .or. iter .gt. 5) call fail(93)
if (res_norm .gt. TOL) call fail(94)
if (convergence_correction_norm .le. ZERO) call fail(101)
dof = dof_id(1,2)
call check_close(u(dof), 15.0_rk / 68.0_rk, 95)
call check_close(v(dof), 75.0_rk / 17.0_rk, 96)
call check_close(a(dof), 1500.0_rk / 17.0_rk, 97)
call check_close(u(dof_id(2,2)), ZERO, 98)
call check_close(u(dof_id(3,2)), ZERO, 99)
call database_finalize(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(100)
end subroutine check_newmark_nonlinear_elastic
subroutine check_newmark_nonlinear_robin()
integer :: ierr
integer :: iter
integer :: dof
real(rk) :: res_norm
call setup_pull_model(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(110)
call database_allocate_robin(1, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(111)
call element_compute_lumped_mass(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(112)
robin_target(1) = '2'
robin_dof(1) = 1
robin_stiffness(1) = 6.0_rk
robin_damping(1) = ZERO
robin_reference(1) = 0.25_rk
robin_amp(1) = 0
current_time = ZERO
call implicit_newmark_nonlinear_step(0.1_rk, 0.25_rk, 0.5_rk, &
50, 1.0e-12_rk, iter, res_norm, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(113)
if (iter .le. 0 .or. iter .gt. 5) call fail(114)
if (res_norm .gt. TOL) call fail(115)
dof = dof_id(1,2)
call check_close(u(dof), 39.0_rk / 172.0_rk, 116)
call database_finalize(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(117)
end subroutine check_newmark_nonlinear_robin
subroutine check_newmark_nonlinear_mpc()
integer :: ierr
integer :: iter
integer :: dof
real(rk) :: res_norm
call setup_single_free_dof_model(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(120)
call database_allocate_mpc(1, 1, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(121)
call element_compute_lumped_mass(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(122)
mpc_start(1) = 1
mpc_count(1) = 1
mpc_rhs(1) = 0.25_rk
mpc_penalty(1) = 6.0_rk
mpc_node(1) = 2
mpc_dof(1) = 1
mpc_coeff(1) = ONE
current_time = ZERO
call implicit_newmark_nonlinear_step(0.1_rk, 0.25_rk, 0.5_rk, &
50, 1.0e-12_rk, iter, res_norm, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(123)
if (iter .le. 0 .or. iter .gt. 5) call fail(124)
if (res_norm .gt. TOL) call fail(125)
dof = dof_id(1,2)
call check_close(u(dof), 9.0_rk / 172.0_rk, 126)
call database_finalize(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(127)
end subroutine check_newmark_nonlinear_mpc
subroutine check_newmark_nonlinear_contact()
integer :: ierr
integer :: iter
integer :: dof
real(rk) :: res_norm
call setup_single_free_dof_model(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(130)
call database_allocate_contact(1, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(131)
call element_compute_lumped_mass(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(132)
contact_target(1) = '2'
contact_normal(:,1) = (/ ONE, ZERO, ZERO /)
contact_offset(1) = 1.1_rk
contact_penalty(1) = 10.0_rk
contact_damping(1) = ZERO
current_time = ZERO
call implicit_newmark_nonlinear_step(0.1_rk, 0.25_rk, 0.5_rk, &
50, 1.0e-12_rk, iter, res_norm, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(133)
if (iter .le. 0 .or. iter .gt. 5) call fail(134)
if (res_norm .gt. TOL) call fail(135)
dof = dof_id(1,2)
call check_close(u(dof), 3.0_rk / 98.0_rk, 136)
call database_finalize(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(137)
end subroutine check_newmark_nonlinear_contact
subroutine check_newmark_trial_rollback()
integer :: ierr
integer :: iter
integer :: dof
real(rk) :: res_norm
call setup_single_free_dof_model(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(140)
call element_compute_lumped_mass(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(141)
dof = dof_id(1,2)
u(dof) = 0.2_rk
current_time = ZERO
call implicit_newmark_nonlinear_step(0.1_rk, 0.25_rk, 0.5_rk, &
1, 1.0e-30_rk, iter, res_norm, ierr)
if (ierr .eq. FEM_SUCCESS) call fail(142)
if (.not. allocated(stress)) call fail(143)
if (maxval(abs(stress)) .gt. TOL) call fail(144)
if (maxval(abs(strain)) .gt. TOL) call fail(145)
if (maxval(abs(statev)) .gt. TOL) call fail(146)
call database_finalize(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(147)
end subroutine check_newmark_trial_rollback
subroutine check_static_cutback_rollback()
integer :: ierr
integer :: iter
real(rk) :: res_norm
logical :: old_cutback
integer :: old_max_cutback
real(rk) :: old_min_increment
real(rk) :: old_cutback_factor
call setup_pull_model(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(150)
old_cutback = allow_step_cutback
old_max_cutback = max_cutback
old_min_increment = static_min_increment
old_cutback_factor = cutback_factor
allow_step_cutback = .true.
max_cutback = 2
static_min_increment = 0.2_rk
cutback_factor = 0.5_rk
current_time = ZERO
call implicit_solve_nonlinear_static(ONE, 1, 1, 1.0e-30_rk, &
iter, res_norm, ierr)
if (ierr .eq. FEM_SUCCESS) call fail(151)
if (abs(current_time) .gt. TOL) call fail(152)
if (maxval(abs(u)) .gt. TOL) call fail(153)
if (allocated(stress)) then
if (maxval(abs(stress)) .gt. TOL) call fail(154)
end if
if (allocated(strain)) then
if (maxval(abs(strain)) .gt. TOL) call fail(155)
end if
if (allocated(statev)) then
if (maxval(abs(statev)) .gt. TOL) call fail(156)
end if
if (convergence_cutback_count .ne. 2) call fail(158)
if (convergence_status_code .ne. CONVERGENCE_STATUS_FAILED) call fail(159)
if (convergence_converged) call fail(160)
call check_close(convergence_last_dt, 0.25_rk, 161)
if (convergence_failure_code .ne. CONV_FAIL_CUTBACK_LIMIT) &
call fail(162)
call check_close(convergence_last_accepted_time, ZERO, 163)
allow_step_cutback = old_cutback
max_cutback = old_max_cutback
static_min_increment = old_min_increment
cutback_factor = old_cutback_factor
call database_finalize(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(157)
end subroutine check_static_cutback_rollback
subroutine setup_pull_model(ierr)
integer, intent(out) :: ierr
call setup_base_tet(4, 1, ierr)
if (ierr .ne. FEM_SUCCESS) return
bc_target(1) = '1'
bc_dof_start(1) = 1
bc_dof_end(1) = 3
bc_value(1) = ZERO
bc_target(2) = '2'
bc_dof_start(2) = 2
bc_dof_end(2) = 3
bc_value(2) = ZERO
bc_target(3) = '3'
bc_dof_start(3) = 1
bc_dof_end(3) = 3
bc_value(3) = ZERO
bc_target(4) = '4'
bc_dof_start(4) = 1
bc_dof_end(4) = 3
bc_value(4) = ZERO
cload_target(1) = '2'
cload_dof(1) = 1
cload_value(1) = 5.0_rk
ierr = FEM_SUCCESS
end subroutine setup_pull_model
subroutine setup_single_free_dof_model(ierr)
integer, intent(out) :: ierr
call setup_base_tet(4, 0, ierr)
if (ierr .ne. FEM_SUCCESS) return
bc_target(1) = '1'
bc_dof_start(1) = 1
bc_dof_end(1) = 3
bc_value(1) = ZERO
bc_target(2) = '2'
bc_dof_start(2) = 2
bc_dof_end(2) = 3
bc_value(2) = ZERO
bc_target(3) = '3'
bc_dof_start(3) = 1
bc_dof_end(3) = 3
bc_value(3) = ZERO
bc_target(4) = '4'
bc_dof_start(4) = 1
bc_dof_end(4) = 3
bc_value(4) = ZERO
ierr = FEM_SUCCESS
end subroutine setup_single_free_dof_model
subroutine setup_prescribed_model(ierr)
integer, intent(out) :: ierr
call setup_base_tet(5, 0, ierr)
if (ierr .ne. FEM_SUCCESS) return
bc_target(1) = '1'
bc_dof_start(1) = 1
bc_dof_end(1) = 3
bc_value(1) = ZERO
bc_target(2) = '2'
bc_dof_start(2) = 1
bc_dof_end(2) = 1
bc_value(2) = 0.25_rk
bc_target(3) = '2'
bc_dof_start(3) = 2
bc_dof_end(3) = 3
bc_value(3) = ZERO
bc_target(4) = '3'
bc_dof_start(4) = 1
bc_dof_end(4) = 3
bc_value(4) = ZERO
bc_target(5) = '4'
bc_dof_start(5) = 1
bc_dof_end(5) = 3
bc_value(5) = ZERO
ierr = FEM_SUCCESS
end subroutine setup_prescribed_model
subroutine setup_base_tet(num_bc, num_cload, ierr)
integer, intent(in) :: num_bc
integer, intent(in) :: num_cload
integer, intent(out) :: ierr
integer :: i
call database_allocate_model(4, 1, 0, 0, 0, 0, 1, 0, 1, &
0, 0, num_bc, num_cload, 0, ierr)
if (ierr .ne. FEM_SUCCESS) return
do i = 1, 4
node_id_ext(i) = i
coord0(:,i) = ZERO
coord(:,i) = ZERO
end do
coord0(:,2) = (/ ONE, ZERO, ZERO /)
coord0(:,3) = (/ ZERO, ONE, ZERO /)
coord0(:,4) = (/ ZERO, ZERO, ONE /)
elem_id_ext(1) = 1
elem_type(1) = 'C3D4'
elem_nnode(1) = 4
elem_conn(:,1) = 0
elem_conn(1:4,1) = (/ 1, 2, 3, 4 /)
elem_mat(1) = 1
elem_sec(1) = 1
section_type(1) = 'SOLID'
section_elset_name(1) = 'EALL'
section_material_name(1) = 'MAT'
mat_name(1) = 'MAT'
mat_density(1) = ONE
mat_e(1) = 30.0_rk
mat_nu(1) = 0.25_rk
call database_assign_dofs(ierr)
end subroutine setup_base_tet
subroutine check_close(actual, expected, code)
real(rk), intent(in) :: actual
real(rk), intent(in) :: expected
integer, intent(in) :: code
if (abs(actual - expected) .gt. TOL) call fail(code)
end subroutine check_close
subroutine fail(code)
integer, intent(in) :: code
write(*,*) 'test_solver_implicit failed:', code
stop 1
end subroutine fail
end program test_solver_implicit