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