264 lines
8.1 KiB
Fortran
264 lines
8.1 KiB
Fortran
program test_restart
|
|
use fem_precision
|
|
use fem_error
|
|
use fem_api
|
|
use fem_contact_multiplier, only: contact_multiplier_store_trial, &
|
|
contact_multiplier_commit, contact_multiplier_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'
|
|
|
|
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 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
|
|
|
|
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
|
|
|
|
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)
|
|
|
|
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 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
|
|
|
|
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)
|
|
end subroutine check_contact_history_restart
|
|
|
|
subroutine check_mult_restart(ierr)
|
|
integer, intent(out) :: ierr
|
|
integer :: slot_count
|
|
integer :: active_count
|
|
real(rk) :: max_lambda
|
|
real(rk) :: max_gap
|
|
|
|
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 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. 1) call fail(24)
|
|
if (active_count .ne. 1) call fail(25)
|
|
call check_close(max_lambda, 7.0_rk, 26)
|
|
call check_close(max_gap, 0.03_rk, 27)
|
|
end subroutine check_mult_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_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
|