377 lines
13 KiB
Fortran
377 lines
13 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
|
|
use fem_contact_history, only: contact_history_state_stats
|
|
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
|
|
|
|
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_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)
|
|
|
|
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 (hist_slots_before .ne. slots_before) call fail(360)
|
|
if (stick_before + slip_state_before .ne. hist_slots_before) &
|
|
call fail(361)
|
|
|
|
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)
|
|
if (hist_slots_after .ne. 0) call fail(362)
|
|
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)
|
|
|
|
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)
|
|
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
|
|
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 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 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 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
|