Files
FemLite/tests/module/test_restart.f90
T
shenw 2b7962eb96
FemLite CI / build-test (push) Has been cancelled
Release FemLite 0.5.3
2026-07-01 18:39:18 +08:00

527 lines
20 KiB
Fortran

program test_restart
use fem_precision
use fem_error
use fem_api
use fem_shell_rotation, only: shell_rotation_ensure, &
shell_rotation_set_committed, shell_rotation_get_committed, &
shell_rotation_rotate_vector
use fem_contact_multiplier, only: contact_multiplier_store_trial, &
contact_multiplier_commit, contact_multiplier_stats, &
contact_multiplier_audit, contact_multiplier_state_counts, &
contact_multiplier_resid_stats
use fem_contact_history, only: contact_history_state_stats, &
contact_history_stable_counts
implicit none
real(rk), parameter :: DT_TEST = 1.0e-8_rk
real(rk), parameter :: DT_CONTACT = 1.0e-5_rk
integer, parameter :: CONTACT_STEPS = 20
character(len=*), parameter :: RESTART_FILE = &
'build-wsl-debug/restart_check.frs'
character(len=*), parameter :: CONTACT_RESTART_FILE = &
'build-wsl-debug/contact_history_restart.frs'
character(len=*), parameter :: MULT_RESTART_FILE = &
'build-wsl-debug/contact_multiplier_restart.frs'
character(len=*), parameter :: ROT_RESTART_FILE = &
'build-wsl-debug/shell_rotation_restart.frs'
integer :: ierr
integer :: ref_step
integer :: rst_step
real(rk) :: ref_time
real(rk) :: rst_time
real(rk) :: ref_u(NDIM)
real(rk) :: ref_v(NDIM)
real(rk) :: ref_a(NDIM)
real(rk) :: rst_u(NDIM)
real(rk) :: rst_v(NDIM)
real(rk) :: rst_a(NDIM)
call fem_initialize(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(1)
call run_continuous(ref_step, ref_time, ref_u, ref_v, ref_a, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(2)
call run_restarted(rst_step, rst_time, rst_u, rst_v, rst_a, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(3)
if (ref_step .ne. 3) call fail(4)
if (rst_step .ne. ref_step) call fail(5)
call check_close(rst_time, ref_time, 6)
call check_vector(rst_u, ref_u, 7)
call check_vector(rst_v, ref_v, 8)
call check_vector(rst_a, ref_a, 9)
call check_contact_history_restart(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(11)
call check_mult_restart(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(22)
call check_shell_rotation_restart(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(40)
call fem_finalize(ierr)
if (ierr .ne. FEM_SUCCESS) call fail(12)
contains
subroutine run_continuous(step, time, disp, vel, acc, ierr)
integer, intent(out) :: step
real(rk), intent(out) :: time
real(rk), intent(out) :: disp(NDIM)
real(rk), intent(out) :: vel(NDIM)
real(rk), intent(out) :: acc(NDIM)
integer, intent(out) :: ierr
call prepare_model(ierr)
if (ierr .ne. FEM_SUCCESS) return
call loaded_step(ierr)
if (ierr .ne. FEM_SUCCESS) return
call loaded_step(ierr)
if (ierr .ne. FEM_SUCCESS) return
call loaded_step(ierr)
if (ierr .ne. FEM_SUCCESS) return
call fem_get_current_time(time, step, ierr)
if (ierr .ne. FEM_SUCCESS) return
call fem_get_node_kinematics(2, disp, vel, acc, ierr)
end subroutine run_continuous
subroutine run_restarted(step, time, disp, vel, acc, ierr)
integer, intent(out) :: step
real(rk), intent(out) :: time
real(rk), intent(out) :: disp(NDIM)
real(rk), intent(out) :: vel(NDIM)
real(rk), intent(out) :: acc(NDIM)
integer, intent(out) :: ierr
call prepare_model(ierr)
if (ierr .ne. FEM_SUCCESS) return
call loaded_step(ierr)
if (ierr .ne. FEM_SUCCESS) return
call loaded_step(ierr)
if (ierr .ne. FEM_SUCCESS) return
call fem_write_restart(RESTART_FILE, ierr)
if (ierr .ne. FEM_SUCCESS) return
call prepare_model(ierr)
if (ierr .ne. FEM_SUCCESS) return
call fem_read_restart(RESTART_FILE, ierr)
if (ierr .ne. FEM_SUCCESS) return
call loaded_step(ierr)
if (ierr .ne. FEM_SUCCESS) return
call fem_get_current_time(time, step, ierr)
if (ierr .ne. FEM_SUCCESS) return
call fem_get_node_kinematics(2, disp, vel, acc, ierr)
end subroutine run_restarted
subroutine prepare_model(ierr)
integer, intent(out) :: ierr
call fem_read_inp('examples/c3d4_one_element.inp', ierr)
if (ierr .ne. FEM_SUCCESS) return
call fem_build_model(ierr)
if (ierr .ne. FEM_SUCCESS) return
call fem_compute_lumped_mass(ierr)
end subroutine prepare_model
subroutine loaded_step(ierr)
integer, intent(out) :: ierr
real(rk) :: force(NDIM)
force = ZERO
force(1) = 5.0_rk
force(2) = 1.0_rk
force(3) = -2.0_rk
call fem_clear_sph_forces(ierr)
if (ierr .ne. FEM_SUCCESS) return
call fem_apply_sph_nodal_force(2, force, ierr)
if (ierr .ne. FEM_SUCCESS) return
call fem_advance_explicit(DT_TEST, ierr)
end subroutine loaded_step
subroutine check_contact_history_restart(ierr)
integer, intent(out) :: ierr
integer :: slots_before
integer :: slots_after
real(rk) :: slip_before
real(rk) :: work_before
real(rk) :: tangent_before
real(rk) :: slip_after
real(rk) :: work_after
real(rk) :: tangent_after
integer :: hist_slots_before
integer :: stick_before
integer :: slip_state_before
integer :: hist_slots_after
integer :: stick_after
integer :: slip_state_after
integer :: stable_slots_before
integer :: state_open_before
integer :: state_stick_before
integer :: state_slip_before
integer :: state_restick_before
integer :: state_separating_before
integer :: state_failed_before
integer :: stable_slots_after
integer :: state_open_after
integer :: state_stick_after
integer :: state_slip_after
integer :: state_restick_after
integer :: state_separating_after
integer :: state_failed_after
integer :: active_summary_before
integer :: active_summary_after
integer :: active_pair_before
integer :: activated_pair_before
integer :: maintained_pair_before
integer :: released_pair_before
integer :: active_pair_after
integer :: activated_pair_after
integer :: maintained_pair_after
integer :: released_pair_after
real(rk) :: work_step_before
real(rk) :: work_total_before
real(rk) :: max_pen_before
real(rk) :: force_norm_before
real(rk) :: work_step_after
real(rk) :: work_total_after
real(rk) :: max_pen_after
real(rk) :: force_norm_after
real(rk) :: max_gap_before
real(rk) :: max_aug_before
real(rk) :: max_gap_after
real(rk) :: max_aug_after
real(rk) :: fric_step_before
real(rk) :: fric_total_before
real(rk) :: max_slip_before
real(rk) :: fric_step_after
real(rk) :: fric_total_after
real(rk) :: max_slip_after
call prepare_contact_model(ierr)
if (ierr .ne. FEM_SUCCESS) return
call run_contact_steps(CONTACT_STEPS, ierr)
if (ierr .ne. FEM_SUCCESS) return
call fem_get_contact_summary(active_summary_before, work_step_before, &
work_total_before, max_pen_before, force_norm_before, ierr)
if (ierr .ne. FEM_SUCCESS) return
call fem_get_contact_diagnostics(active_pair_before, &
activated_pair_before, maintained_pair_before, released_pair_before, &
max_gap_before, max_aug_before, ierr)
if (ierr .ne. FEM_SUCCESS) return
call fem_get_contact_friction(fric_step_before, fric_total_before, &
max_slip_before, ierr)
if (ierr .ne. FEM_SUCCESS) return
call fem_get_contact_hist_stats(slots_before, slip_before, &
work_before, tangent_before, ierr)
if (ierr .ne. FEM_SUCCESS) return
call contact_history_state_stats(hist_slots_before, stick_before, &
slip_state_before)
call contact_history_stable_counts(stable_slots_before, &
state_open_before, state_stick_before, state_slip_before, &
state_restick_before, state_separating_before, state_failed_before)
if (slots_before .le. 0) call fail(13)
if (slip_before .le. ZERO) call fail(14)
if (work_before .le. ZERO) call fail(15)
if (tangent_before .le. ZERO) call fail(16)
if (active_summary_before .le. 0) call fail(395)
if (active_pair_before .le. 0) call fail(396)
if (force_norm_before .le. ZERO) call fail(397)
if (max_gap_before .le. ZERO) call fail(398)
if (max_slip_before .le. ZERO) call fail(399)
if (hist_slots_before .ne. slots_before) call fail(360)
if (stick_before + slip_state_before .ne. hist_slots_before) &
call fail(361)
if (stable_slots_before .ne. hist_slots_before) call fail(367)
if (state_open_before .ne. 0) call fail(368)
if (state_stick_before .ne. stick_before) call fail(369)
if (state_slip_before .ne. slip_state_before) call fail(370)
if (state_restick_before + state_separating_before + &
state_failed_before .ne. 0) call fail(371)
call fem_write_restart(CONTACT_RESTART_FILE, ierr)
if (ierr .ne. FEM_SUCCESS) return
call prepare_contact_model(ierr)
if (ierr .ne. FEM_SUCCESS) return
call contact_history_state_stats(hist_slots_after, stick_after, &
slip_state_after)
call contact_history_stable_counts(stable_slots_after, &
state_open_after, state_stick_after, state_slip_after, &
state_restick_after, state_separating_after, state_failed_after)
if (hist_slots_after .ne. 0) call fail(362)
if (stable_slots_after .ne. 0) call fail(372)
call fem_get_contact_hist_stats(slots_after, slip_after, work_after, &
tangent_after, ierr)
if (ierr .ne. FEM_SUCCESS) return
if (slots_after .ne. 0) call fail(17)
call fem_read_restart(CONTACT_RESTART_FILE, ierr)
if (ierr .ne. FEM_SUCCESS) return
call fem_get_contact_hist_stats(slots_after, slip_after, work_after, &
tangent_after, ierr)
if (ierr .ne. FEM_SUCCESS) return
call contact_history_state_stats(hist_slots_after, stick_after, &
slip_state_after)
call contact_history_stable_counts(stable_slots_after, &
state_open_after, state_stick_after, state_slip_after, &
state_restick_after, state_separating_after, state_failed_after)
if (slots_after .ne. slots_before) call fail(18)
call check_close(slip_after, slip_before, 19)
call check_close(work_after, work_before, 20)
call check_close(tangent_after, tangent_before, 21)
if (hist_slots_after .ne. hist_slots_before) call fail(363)
if (stick_after .ne. stick_before) call fail(364)
if (slip_state_after .ne. slip_state_before) call fail(365)
if (stick_after + slip_state_after .ne. hist_slots_after) call fail(366)
if (stable_slots_after .ne. stable_slots_before) call fail(373)
if (state_open_after .ne. state_open_before) call fail(374)
if (state_stick_after .ne. state_stick_before) call fail(375)
if (state_slip_after .ne. state_slip_before) call fail(376)
if (state_restick_after .ne. state_restick_before) call fail(377)
if (state_separating_after .ne. state_separating_before) call fail(378)
if (state_failed_after .ne. state_failed_before) call fail(379)
call fem_get_contact_summary(active_summary_after, work_step_after, &
work_total_after, max_pen_after, force_norm_after, ierr)
if (ierr .ne. FEM_SUCCESS) return
call fem_get_contact_diagnostics(active_pair_after, activated_pair_after, &
maintained_pair_after, released_pair_after, max_gap_after, &
max_aug_after, ierr)
if (ierr .ne. FEM_SUCCESS) return
call fem_get_contact_friction(fric_step_after, fric_total_after, &
max_slip_after, ierr)
if (ierr .ne. FEM_SUCCESS) return
if (active_summary_after .ne. active_summary_before) call fail(400)
if (active_pair_after .ne. active_pair_before) call fail(401)
if (activated_pair_after .ne. activated_pair_before) call fail(402)
if (maintained_pair_after .ne. maintained_pair_before) call fail(403)
if (released_pair_after .ne. released_pair_before) call fail(404)
call check_close(work_step_after, work_step_before, 405)
call check_close(work_total_after, work_total_before, 406)
call check_close(max_pen_after, max_pen_before, 407)
call check_close(force_norm_after, force_norm_before, 408)
call check_close(max_gap_after, max_gap_before, 409)
call check_close(max_aug_after, max_aug_before, 410)
call check_close(fric_step_after, fric_step_before, 411)
call check_close(fric_total_after, fric_total_before, 412)
call check_close(max_slip_after, max_slip_before, 413)
end subroutine check_contact_history_restart
subroutine check_mult_restart(ierr)
integer, intent(out) :: ierr
integer :: slot_count
integer :: active_count
integer :: released_count
integer :: open_count
integer :: duplicate_count
integer :: invalid_count
integer :: state_slots
integer :: state_open
integer :: state_stick
integer :: state_slip
integer :: state_restick
integer :: state_separating
integer :: state_failed
integer :: al_update_before
integer :: al_update_after
real(rk) :: mult_resid_before
real(rk) :: mult_resid_after
real(rk) :: max_lambda
real(rk) :: max_gap
real(rk) :: max_commit_error
call prepare_model(ierr)
if (ierr .ne. FEM_SUCCESS) return
call contact_multiplier_store_trial(1, 10, 2, 20, 3, 1, 7.0_rk, &
0.03_rk, .true., ierr)
if (ierr .ne. FEM_SUCCESS) return
call contact_multiplier_commit()
call contact_multiplier_store_trial(1, 10, 2, 20, 3, 1, ZERO, &
0.01_rk, .false., ierr)
if (ierr .ne. FEM_SUCCESS) return
call contact_multiplier_store_trial(1, 11, 2, 20, 3, 1, 9.0_rk, &
0.04_rk, .true., ierr)
if (ierr .ne. FEM_SUCCESS) return
call contact_multiplier_store_trial(1, 12, 2, 20, 3, 1, ZERO, &
0.02_rk, .false., ierr)
if (ierr .ne. FEM_SUCCESS) return
call contact_multiplier_commit()
call contact_multiplier_audit(slot_count, active_count, &
released_count, open_count, duplicate_count, invalid_count, &
max_lambda, max_gap, max_commit_error, ierr)
if (ierr .ne. FEM_SUCCESS) return
if (slot_count .ne. 3) call fail(28)
if (active_count .ne. 1) call fail(29)
if (released_count .ne. 1) call fail(30)
if (open_count .ne. 1) call fail(31)
if (duplicate_count .ne. 0 .or. invalid_count .ne. 0) call fail(32)
call contact_multiplier_state_counts(state_slots, state_open, &
state_stick, state_slip, state_restick, state_separating, &
state_failed, ierr)
if (ierr .ne. FEM_SUCCESS) return
if (state_slots .ne. 3) call fail(380)
if (state_open .ne. 1) call fail(381)
if (state_stick .ne. 1) call fail(382)
if (state_slip + state_restick + state_failed .ne. 0) call fail(383)
if (state_separating .ne. 1) call fail(384)
call contact_multiplier_resid_stats(mult_resid_before, &
al_update_before, ierr)
if (ierr .ne. FEM_SUCCESS) return
call check_close(mult_resid_before, ZERO, 391)
if (al_update_before .ne. 0) call fail(392)
call check_close(max_lambda, 9.0_rk, 33)
call check_close(max_gap, 0.04_rk, 34)
call check_close(max_commit_error, ZERO, 35)
call fem_write_restart(MULT_RESTART_FILE, ierr)
if (ierr .ne. FEM_SUCCESS) return
call prepare_model(ierr)
if (ierr .ne. FEM_SUCCESS) return
call contact_multiplier_stats(slot_count, active_count, max_lambda, max_gap)
if (slot_count .ne. 0) call fail(23)
call contact_multiplier_state_counts(state_slots, state_open, &
state_stick, state_slip, state_restick, state_separating, &
state_failed, ierr)
if (ierr .ne. FEM_SUCCESS) return
if (state_slots .ne. 0) call fail(385)
call fem_read_restart(MULT_RESTART_FILE, ierr)
if (ierr .ne. FEM_SUCCESS) return
call contact_multiplier_stats(slot_count, active_count, max_lambda, max_gap)
if (slot_count .ne. 3) call fail(24)
if (active_count .ne. 1) call fail(25)
call check_close(max_lambda, 9.0_rk, 26)
call check_close(max_gap, 0.04_rk, 27)
call contact_multiplier_audit(slot_count, active_count, &
released_count, open_count, duplicate_count, invalid_count, &
max_lambda, max_gap, max_commit_error, ierr)
if (ierr .ne. FEM_SUCCESS) return
if (released_count .ne. 1) call fail(36)
if (open_count .ne. 1) call fail(37)
if (duplicate_count .ne. 0 .or. invalid_count .ne. 0) call fail(38)
call contact_multiplier_state_counts(state_slots, state_open, &
state_stick, state_slip, state_restick, state_separating, &
state_failed, ierr)
if (ierr .ne. FEM_SUCCESS) return
if (state_slots .ne. 3) call fail(386)
if (state_open .ne. 1) call fail(387)
if (state_stick .ne. 1) call fail(388)
if (state_separating .ne. 1) call fail(389)
if (state_slip + state_restick + state_failed .ne. 0) call fail(390)
call contact_multiplier_resid_stats(mult_resid_after, al_update_after, &
ierr)
if (ierr .ne. FEM_SUCCESS) return
call check_close(mult_resid_after, mult_resid_before, 393)
if (al_update_after .ne. al_update_before) call fail(394)
call check_close(max_commit_error, ZERO, 39)
end subroutine check_mult_restart
subroutine check_shell_rotation_restart(ierr)
integer, intent(out) :: ierr
real(rk) :: theta
real(rk) :: q_before(4)
real(rk) :: q_after(4)
real(rk) :: vec(NDIM)
real(rk) :: rotated(NDIM)
call prepare_model(ierr)
if (ierr .ne. FEM_SUCCESS) return
call shell_rotation_ensure(ierr)
if (ierr .ne. FEM_SUCCESS) return
theta = 4.0_rk * atan(ONE) / 3.0_rk
q_before = ZERO
q_before(1) = cos(HALF * theta)
q_before(3) = sin(HALF * theta)
call shell_rotation_set_committed(2, q_before, ierr)
if (ierr .ne. FEM_SUCCESS) return
call fem_write_restart(ROT_RESTART_FILE, ierr)
if (ierr .ne. FEM_SUCCESS) return
call prepare_model(ierr)
if (ierr .ne. FEM_SUCCESS) return
call fem_read_restart(ROT_RESTART_FILE, ierr)
if (ierr .ne. FEM_SUCCESS) return
call shell_rotation_get_committed(2, q_after, ierr)
if (ierr .ne. FEM_SUCCESS) return
call check_vector4(q_after, q_before, 41)
vec = (/ ZERO, ZERO, ONE /)
call shell_rotation_rotate_vector(2, vec, rotated, ierr, .false.)
if (ierr .ne. FEM_SUCCESS) return
call check_close(rotated(1), sin(theta), 42)
call check_close(rotated(2), ZERO, 43)
call check_close(rotated(3), cos(theta), 44)
end subroutine check_shell_rotation_restart
subroutine prepare_contact_model(ierr)
integer, intent(out) :: ierr
call fem_read_inp('examples/contact_block_sliding/block_sliding_friction.inp', &
ierr)
if (ierr .ne. FEM_SUCCESS) return
call fem_build_model(ierr)
if (ierr .ne. FEM_SUCCESS) return
call fem_compute_lumped_mass(ierr)
end subroutine prepare_contact_model
subroutine run_contact_steps(step_count, ierr)
integer, intent(in) :: step_count
integer, intent(out) :: ierr
integer :: step
do step = 1, step_count
call fem_advance_explicit(DT_CONTACT, ierr)
if (ierr .ne. FEM_SUCCESS) return
end do
ierr = FEM_SUCCESS
end subroutine run_contact_steps
subroutine check_vector(actual, expected, code)
real(rk), intent(in) :: actual(NDIM)
real(rk), intent(in) :: expected(NDIM)
integer, intent(in) :: code
integer :: idir
do idir = 1, NDIM
call check_close(actual(idir), expected(idir), code)
end do
end subroutine check_vector
subroutine check_vector4(actual, expected, code)
real(rk), intent(in) :: actual(4)
real(rk), intent(in) :: expected(4)
integer, intent(in) :: code
integer :: i
do i = 1, 4
call check_close(actual(i), expected(i), code)
end do
end subroutine check_vector4
subroutine check_close(actual, expected, code)
real(rk), intent(in) :: actual
real(rk), intent(in) :: expected
integer, intent(in) :: code
real(rk) :: scale
scale = max(ONE, abs(expected))
if (abs(actual - expected) .gt. 1.0e-8_rk * scale) call fail(code)
end subroutine check_close
subroutine fail(code)
integer, intent(in) :: code
write(*,*) 'test_restart failed:', code
stop 1
end subroutine fail
end program test_restart