453 lines
17 KiB
Fortran
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
|