Files
FemLite/tests/module/test_contact_mortar_al.f90
T
2026-06-26 00:48:57 +08:00

453 lines
17 KiB
Fortran

program test_contact_mortar_al
use fem_precision
use fem_error
use fem_contact_multiplier
use fem_contact_mortar_al
use fem_contact_mortar_batch
implicit none
real(rk), parameter :: TOL = 1.0e-10_rk
call check_params_and_names()
call check_point_update()
call check_store_multiplier()
call check_summary_and_adapt()
call check_batch_update()
call check_batch_store()
call check_distribution()
call check_residual_norm()
call check_error_paths()
contains
subroutine check_params_and_names()
type(mortar_al_params) :: params
integer :: ierr
call mortar_al_params_init(100.0_rk, 1.0e-5_rk, params, ierr)
call require_success(ierr, 10)
call check_close(params%penalty, 100.0_rk, 11)
call check_close(params%min_penalty, ONE, 12)
call check_close(params%max_penalty, 100000.0_rk, 13)
call check_close(params%gap_tolerance, 1.0e-5_rk, 14)
if (trim(mortar_al_status_name(MORTAR_AL_ACTIVE)) .ne. 'ACTIVE') call fail(15)
if (trim(mortar_al_status_name(MORTAR_AL_RELEASED)) .ne. 'RELEASED') call fail(16)
if (trim(mortar_al_status_name(MORTAR_AL_OPEN)) .ne. 'OPEN') call fail(17)
if (trim(mortar_al_adapt_name(MORTAR_AL_ADAPT_GROW)) .ne. 'GROW') call fail(18)
if (trim(mortar_al_adapt_name(MORTAR_AL_ADAPT_SHRINK)) .ne. 'SHRINK') call fail(19)
if (trim(mortar_al_adapt_name(MORTAR_AL_ADAPT_KEEP)) .ne. 'KEEP') call fail(20)
params%penalty = ZERO
call mortar_al_params_validate(params, ierr)
if (ierr .eq. FEM_SUCCESS) call fail(21)
end subroutine check_params_and_names
subroutine check_point_update()
type(mortar_al_params) :: params
type(mortar_al_point) :: point
integer :: ierr
call mortar_al_params_init(100.0_rk, 0.01_rk, params, ierr)
call require_success(ierr, 30)
params%lambda_tolerance = 1.0e-8_rk
params%max_lambda_update = 3.0_rk
call mortar_al_params_validate(params, ierr)
call require_success(ierr, 31)
call mortar_al_update_point(params, 1, 10, 2, 20, 3, 4, 0.02_rk, &
2.0_rk, 0.25_rk, ZERO, point, ierr)
call require_success(ierr, 32)
if (point%status .ne. MORTAR_AL_ACTIVE) call fail(33)
call check_close(point%trial_lambda, 2.0_rk, 34)
call check_close(point%lambda_update, 2.0_rk, 35)
call check_close(point%gap_residual, 0.02_rk, 36)
call check_close(point%weighted_gap, 0.01_rk, 37)
call check_close(point%normal_work, 0.01_rk, 38)
call mortar_al_update_point(params, 1, 10, 2, 20, 3, 4, 0.20_rk, &
2.0_rk, ONE, ZERO, point, ierr)
call require_success(ierr, 39)
call check_close(point%trial_lambda, 3.0_rk, 40)
call check_close(point%lambda_update, 3.0_rk, 41)
call mortar_al_update_point(params, 1, 10, 2, 20, 3, 4, -0.05_rk, &
2.0_rk, ONE, 2.0_rk, point, ierr)
call require_success(ierr, 42)
if (point%status .ne. MORTAR_AL_RELEASED) call fail(43)
call check_close(point%trial_lambda, ZERO, 44)
call check_close(point%gap_residual, ZERO, 45)
call check_close(point%complementarity, ZERO, 46)
if (point%normal_work .ge. ZERO) call fail(47)
end subroutine check_point_update
subroutine check_store_multiplier()
type(mortar_al_params) :: params
type(mortar_al_point) :: point
real(rk) :: old_lambda
integer :: slot_count
integer :: active_count
real(rk) :: max_lambda
real(rk) :: max_gap
integer :: ierr
call contact_multiplier_reset()
call contact_multiplier_begin_trial()
call mortar_al_params_init(50.0_rk, 1.0e-6_rk, params, ierr)
call require_success(ierr, 60)
call mortar_al_update_store(params, 2, 11, 1, 21, 4, 1, 0.04_rk, &
ONE, ONE, point, ierr)
call require_success(ierr, 61)
if (point%status .ne. MORTAR_AL_ACTIVE) call fail(62)
call check_close(point%trial_lambda, 2.0_rk, 63)
call contact_multiplier_old(2, 11, 1, 21, 4, 1, old_lambda)
call check_close(old_lambda, ZERO, 64)
call contact_multiplier_stats(slot_count, active_count, max_lambda, max_gap)
if (slot_count .ne. 1) call fail(65)
if (active_count .ne. 1) call fail(66)
call check_close(max_gap, 0.04_rk, 67)
call contact_multiplier_commit()
call contact_multiplier_old(2, 11, 1, 21, 4, 1, old_lambda)
call check_close(old_lambda, 2.0_rk, 68)
call contact_multiplier_begin_trial()
call mortar_al_update_store(params, 2, 11, 1, 21, 4, 1, -0.10_rk, &
ONE, ONE, point, ierr)
call require_success(ierr, 69)
if (point%status .ne. MORTAR_AL_RELEASED) call fail(70)
call contact_multiplier_commit()
call contact_multiplier_old(2, 11, 1, 21, 4, 1, old_lambda)
call check_close(old_lambda, ZERO, 71)
call contact_multiplier_reset()
end subroutine check_store_multiplier
subroutine check_summary_and_adapt()
type(mortar_al_params) :: params
type(mortar_al_point) :: p1
type(mortar_al_point) :: p2
type(mortar_al_point) :: p3
type(mortar_al_summary) :: summary
type(mortar_al_summary) :: other
type(mortar_al_summary) :: merged
integer :: count
integer :: active
integer :: released
integer :: action
real(rk) :: max_gap
real(rk) :: max_lambda
real(rk) :: max_update
real(rk) :: weighted_gap
real(rk) :: contact_area
real(rk) :: next_penalty
logical :: converged
integer :: ierr
call mortar_al_params_init(100.0_rk, 0.01_rk, params, ierr)
call require_success(ierr, 90)
params%lambda_tolerance = 0.50_rk
params%min_penalty = 25.0_rk
params%max_penalty = 400.0_rk
call mortar_al_params_validate(params, ierr)
call require_success(ierr, 91)
call mortar_al_summary_reset(summary)
call mortar_al_update_point(params, 1, 1, 1, 2, 1, 1, 0.02_rk, &
2.0_rk, 0.25_rk, ZERO, p1, ierr)
call require_success(ierr, 92)
call mortar_al_summary_add(summary, p1, ierr)
call require_success(ierr, 93)
call mortar_al_update_point(params, 1, 1, 1, 2, 1, 2, -0.02_rk, &
2.0_rk, 0.25_rk, ONE, p2, ierr)
call require_success(ierr, 94)
call mortar_al_summary_add(summary, p2, ierr)
call require_success(ierr, 95)
call mortar_al_update_point(params, 1, 1, 1, 2, 1, 3, ZERO, &
2.0_rk, 0.50_rk, ZERO, p3, ierr)
call require_success(ierr, 96)
call mortar_al_summary_add(summary, p3, ierr)
call require_success(ierr, 97)
call mortar_al_summary_values(summary, count, active, released, max_gap, &
max_lambda, max_update, weighted_gap, &
contact_area, ierr)
call require_success(ierr, 98)
if (count .ne. 3) call fail(99)
if (active .ne. 1) call fail(100)
if (released .ne. 1) call fail(101)
call check_close(max_gap, 0.02_rk, 102)
call check_close(max_lambda, 2.0_rk, 103)
call check_close(weighted_gap, 0.01_rk, 104)
call check_close(contact_area, 0.5_rk, 105)
call mortar_al_converged(summary, params, converged, ierr)
call require_success(ierr, 106)
if (converged) call fail(107)
call mortar_al_adapt_penalty(params, summary, next_penalty, action, ierr)
call require_success(ierr, 108)
if (action .ne. MORTAR_AL_ADAPT_GROW) call fail(109)
call check_close(next_penalty, 200.0_rk, 110)
call mortar_al_summary_reset(other)
params%gap_tolerance = 0.05_rk
call mortar_al_update_point(params, 2, 3, 1, 4, 1, 1, ZERO, &
ONE, ONE, ZERO, p1, ierr)
call require_success(ierr, 111)
call mortar_al_summary_add(other, p1, ierr)
call require_success(ierr, 112)
call mortar_al_summary_merge(summary, other, merged, ierr)
call require_success(ierr, 113)
if (merged%point_count .ne. 4) call fail(114)
call mortar_al_converged(other, params, converged, ierr)
call require_success(ierr, 115)
if (.not. converged) call fail(116)
call mortar_al_adapt_penalty(params, other, next_penalty, action, ierr)
call require_success(ierr, 117)
if (action .ne. MORTAR_AL_ADAPT_SHRINK) call fail(118)
call check_close(next_penalty, 50.0_rk, 119)
end subroutine check_summary_and_adapt
subroutine check_batch_update()
type(mortar_al_params) :: params
type(mortar_al_point) :: points(3)
type(mortar_al_summary) :: summary
type(mortar_batch_diag) :: diag
type(mortar_batch_diag) :: other
type(mortar_batch_diag) :: merged
real(rk) :: gaps(3)
real(rk) :: areas(3)
real(rk) :: weights(3)
real(rk) :: old_lambdas(3)
real(rk) :: area
real(rk) :: pressure_avg
real(rk) :: gap_l2
real(rk) :: lambda_l2
integer :: count
integer :: active
integer :: released
logical :: ok
integer :: ierr
call mortar_al_params_init(100.0_rk, 0.01_rk, params, ierr)
call require_success(ierr, 1210)
gaps = (/ 0.02_rk, -0.02_rk, ZERO /)
areas = (/ 2.0_rk, 2.0_rk, ONE /)
weights = (/ 0.25_rk, 0.25_rk, 0.50_rk /)
old_lambdas = (/ ZERO, ONE, ZERO /)
call mortar_batch_update(params, 3, 30, 2, 40, 3, 3, gaps, areas, &
weights, old_lambdas, points, summary, diag, ierr)
call require_success(ierr, 1211)
if (summary%point_count .ne. 3) call fail(1212)
if (summary%active_count .ne. 1) call fail(1213)
if (summary%released_count .ne. 1) call fail(1214)
call mortar_batch_values(diag, count, active, released, area, &
pressure_avg, gap_l2, lambda_l2, ierr)
call require_success(ierr, 1215)
if (count .ne. 3) call fail(1216)
if (active .ne. 1 .or. released .ne. 1) call fail(1217)
call check_close(area, 1.5_rk, 1218)
call check_close(pressure_avg, (2.0_rk * 0.5_rk) / 1.5_rk, 1219)
call check_close(gap_l2, 0.02_rk, 1220)
call check_close(lambda_l2, 2.0_rk, 1221)
call mortar_batch_pressure_ok(diag, ZERO, 2.1_rk, ok, ierr)
call require_success(ierr, 1222)
if (.not. ok) call fail(1223)
call mortar_batch_pressure_ok(diag, 1.0_rk, 2.1_rk, ok, ierr)
call require_success(ierr, 1224)
if (ok) call fail(1225)
gaps = (/ 0.01_rk, ZERO, ZERO /)
areas = (/ ONE, ONE, ONE /)
weights = (/ ONE, ZERO, ZERO /)
old_lambdas = ZERO
call mortar_batch_update(params, 5, 50, 1, 60, 1, 1, gaps(1:1), &
areas(1:1), weights(1:1), old_lambdas(1:1), points(1:1), summary, &
other, ierr)
call require_success(ierr, 1226)
call mortar_batch_merge(diag, other, merged, ierr)
call require_success(ierr, 1227)
if (merged%point_count .ne. 4) call fail(1228)
if (merged%active_count .ne. 2) call fail(1229)
end subroutine check_batch_update
subroutine check_batch_store()
type(mortar_al_params) :: params
type(mortar_al_point) :: points(2)
type(mortar_al_summary) :: summary
type(mortar_batch_diag) :: diag
real(rk) :: gaps(2)
real(rk) :: areas(2)
real(rk) :: weights(2)
real(rk) :: old_lambda
integer :: slots
integer :: active
real(rk) :: max_lambda
real(rk) :: max_gap
integer :: ierr
call contact_multiplier_reset()
call contact_multiplier_begin_trial()
call mortar_al_params_init(100.0_rk, 0.01_rk, params, ierr)
call require_success(ierr, 1240)
gaps = (/ 0.01_rk, 0.03_rk /)
areas = (/ ONE, ONE /)
weights = (/ HALF, HALF /)
call mortar_batch_update_store(params, 4, 41, 1, 42, 2, 2, gaps, &
areas, weights, points, summary, diag, ierr)
call require_success(ierr, 1241)
if (summary%active_count .ne. 2) call fail(1242)
call contact_multiplier_stats(slots, active, max_lambda, max_gap)
if (slots .ne. 2 .or. active .ne. 2) call fail(1243)
call check_close(max_lambda, ZERO, 1244)
call check_close(max_gap, 0.03_rk, 1247)
call contact_multiplier_commit()
call contact_multiplier_old(4, 41, 1, 42, 2, 2, old_lambda)
call check_close(old_lambda, 3.0_rk, 1245)
call contact_multiplier_stats(slots, active, max_lambda, max_gap)
call check_close(max_lambda, 3.0_rk, 1248)
call contact_multiplier_reset()
areas(1) = -ONE
call mortar_batch_update_store(params, 4, 41, 1, 42, 2, 2, gaps, &
areas, weights, points, summary, diag, ierr)
if (ierr .eq. FEM_SUCCESS) call fail(1246)
end subroutine check_batch_store
subroutine check_distribution()
real(rk) :: slave_w(2)
real(rk) :: master_w(3)
real(rk) :: slave_force(3,2)
real(rk) :: master_force(3,3)
real(rk) :: resultant(3)
integer :: ierr
slave_w = (/ 0.25_rk, 0.75_rk /)
master_w = (/ 0.2_rk, 0.3_rk, 0.5_rk /)
call mortar_al_distribute(2, 3, slave_w, master_w, 10.0_rk, 2.0_rk, &
(/ ZERO, ZERO, ONE /), slave_force, master_force, resultant, ierr)
call require_success(ierr, 130)
call check_vec(resultant, (/ ZERO, ZERO, 20.0_rk /), 131)
call check_vec(slave_force(:,1), (/ ZERO, ZERO, 5.0_rk /), 132)
call check_vec(slave_force(:,2), (/ ZERO, ZERO, 15.0_rk /), 133)
call check_vec(master_force(:,1), (/ ZERO, ZERO, -4.0_rk /), 134)
call check_vec(master_force(:,2), (/ ZERO, ZERO, -6.0_rk /), 135)
call check_vec(master_force(:,3), (/ ZERO, ZERO, -10.0_rk /), 136)
call check_vec(sum_forces(slave_force) + sum_forces(master_force), &
(/ ZERO, ZERO, ZERO /), 137)
slave_w = (/ 0.20_rk, 0.70_rk /)
call mortar_al_weight_check(2, 3, slave_w, master_w, ierr)
if (ierr .eq. FEM_SUCCESS) call fail(138)
end subroutine check_distribution
subroutine check_residual_norm()
real(rk) :: gaps(4)
real(rk) :: lambdas(4)
real(rk) :: weights(4)
real(rk) :: max_gap
real(rk) :: comp_norm
real(rk) :: weighted_norm
integer :: ierr
gaps = (/ 0.02_rk, -0.01_rk, ZERO, 0.03_rk /)
lambdas = (/ 2.0_rk, 5.0_rk, ZERO, 3.0_rk /)
weights = (/ 0.25_rk, 0.25_rk, 0.25_rk, 0.25_rk /)
call mortar_al_residual_norm(4, gaps, lambdas, weights, max_gap, &
comp_norm, weighted_norm, ierr)
call require_success(ierr, 150)
call check_close(max_gap, 0.03_rk, 151)
call check_close(comp_norm, 0.05_rk, 152)
call check_close(weighted_norm, sqrt(0.25_rk * (0.02_rk * 0.02_rk + &
0.03_rk * 0.03_rk)), 153)
lambdas(2) = -ONE
call mortar_al_residual_norm(4, gaps, lambdas, weights, max_gap, &
comp_norm, weighted_norm, ierr)
if (ierr .eq. FEM_SUCCESS) call fail(154)
end subroutine check_residual_norm
subroutine check_error_paths()
type(mortar_al_params) :: params
type(mortar_al_point) :: point
type(mortar_al_summary) :: summary
real(rk) :: slave_force(3,1)
real(rk) :: master_force(3,1)
real(rk) :: resultant(3)
real(rk) :: max_gap
real(rk) :: max_lambda
real(rk) :: max_update
real(rk) :: comp_norm
real(rk) :: weighted_norm
real(rk) :: weighted_gap
real(rk) :: contact_area
integer :: count
integer :: active
integer :: released
integer :: ierr
call mortar_al_params_init(100.0_rk, 0.01_rk, params, ierr)
call require_success(ierr, 170)
call mortar_al_update_point(params, 0, 1, 1, 2, 1, 1, ZERO, ONE, ONE, &
ZERO, point, ierr)
if (ierr .eq. FEM_SUCCESS) call fail(171)
call mortar_al_update_point(params, 1, 1, 1, 2, 1, 1, ZERO, -ONE, ONE, &
ZERO, point, ierr)
if (ierr .eq. FEM_SUCCESS) call fail(172)
call mortar_al_distribute(1, 1, (/ ONE /), (/ ONE /), ONE, ONE, &
(/ ZERO, ZERO, 2.0_rk /), slave_force, master_force, resultant, ierr)
if (ierr .eq. FEM_SUCCESS) call fail(173)
call mortar_al_residual_norm(0, (/ ZERO /), (/ ZERO /), (/ ZERO /), &
max_gap, comp_norm, weighted_norm, ierr)
if (ierr .eq. FEM_SUCCESS) call fail(174)
call mortar_al_summary_reset(summary)
summary%point_count = 2
summary%active_count = 1
call mortar_al_summary_values(summary, count, active, released, max_gap, &
max_lambda, max_update, weighted_gap, &
contact_area, ierr)
if (ierr .eq. FEM_SUCCESS) call fail(175)
end subroutine check_error_paths
function sum_forces(forces) result(total)
real(rk), intent(in) :: forces(:,:)
real(rk) :: total(3)
integer :: i
total = ZERO
do i = 1, size(forces, 2)
total = total + forces(:,i)
end do
end function sum_forces
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 * max(ONE, abs(expected))) call fail(code)
end subroutine check_close
subroutine check_vec(actual, expected, code)
real(rk), intent(in) :: actual(3)
real(rk), intent(in) :: expected(3)
integer, intent(in) :: code
if (maxval(abs(actual - expected)) .gt. TOL) call fail(code)
end subroutine check_vec
subroutine require_success(ierr, code)
integer, intent(in) :: ierr
integer, intent(in) :: code
if (ierr .ne. FEM_SUCCESS) call fail(code)
end subroutine require_success
subroutine fail(code)
integer, intent(in) :: code
write(*,*) 'test_contact_mortar_al failed:', code
stop 1
end subroutine fail
end program test_contact_mortar_al