program test_contact_mortar_tangent use fem_precision use fem_error use fem_contact_mortar_cons use fem_contact_mortar_tangent implicit none real(rk), parameter :: TOL = 1.0e-10_rk call check_constraint_basis() call check_force_and_moment() call check_normal_matrix() call check_stick_friction() call check_weighted_matrix() call check_slip_nonsym() call check_projector_diag() call check_error_paths() contains subroutine check_constraint_basis() type(mortar_constraint) :: cons real(rk) :: normal(NDIM) real(rk) :: slip(NDIM) real(rk) :: tangent_vec(NDIM) real(rk) :: vector(NDIM) real(rk) :: normal_value real(rk) :: tangent_norm real(rk) :: coeffs(2*MAX_NEN) integer :: signs(2*MAX_NEN) integer :: coeff_count integer :: nslave integer :: nmaster real(rk) :: area real(rk) :: gap real(rk) :: slip_speed real(rk) :: slave_sum real(rk) :: master_sum integer :: ierr normal = (/ ZERO, ZERO, ONE /) slip = (/ 0.3_rk, 0.4_rk, 0.5_rk /) call mortar_cons_init(1, 1, (/ ONE /), (/ ONE /), normal, 2.0_rk, & 0.01_rk, slip, -0.2_rk, cons, ierr) call require_success(ierr, 10) call check_close(cons%slip(3), ZERO, 11) call check_close(cons%slip_speed, 0.5_rk, 12) call check_close(dot_product(cons%normal, cons%tangent1), ZERO, 13) call check_close(dot_product(cons%normal, cons%tangent2), ZERO, 14) call check_close(dot_product(cons%tangent1, cons%tangent2), ZERO, 15) call check_close(dot_product(cons%tangent1, cons%tangent1), ONE, 16) call check_close(dot_product(cons%tangent2, cons%tangent2), ONE, 17) vector = (/ ONE, 2.0_rk, 3.0_rk /) call mortar_cons_project(cons, vector, normal_value, tangent_vec, & tangent_norm, ierr) call require_success(ierr, 18) call check_close(normal_value, 3.0_rk, 19) call check_vec(tangent_vec, (/ ONE, 2.0_rk, ZERO /), 20) call check_close(tangent_norm, sqrt(5.0_rk), 21) call mortar_cons_coeffs(cons, coeff_count, coeffs, signs, ierr) call require_success(ierr, 22) if (coeff_count .ne. 2) call fail(23) call check_close(coeffs(1), ONE, 24) call check_close(coeffs(2), ONE, 25) if (signs(1) .ne. 1 .or. signs(2) .ne. -1) call fail(26) call mortar_cons_summary(cons, nslave, nmaster, area, gap, slip_speed, & slave_sum, master_sum, ierr) call require_success(ierr, 27) if (nslave .ne. 1 .or. nmaster .ne. 1) call fail(28) call check_close(area, 2.0_rk, 29) call check_close(gap, 0.01_rk, 30) call check_close(slip_speed, 0.5_rk, 31) call check_close(slave_sum, ONE, 32) call check_close(master_sum, ONE, 33) end subroutine check_constraint_basis subroutine check_force_and_moment() type(mortar_constraint) :: cons real(rk) :: slave_x(NDIM,2) real(rk) :: master_x(NDIM,2) real(rk) :: slave_f(NDIM,2) real(rk) :: master_f(NDIM,2) real(rk) :: traction(NDIM) real(rk) :: force_sum(NDIM) real(rk) :: moment_sum(NDIM) real(rk) :: slave_c(NDIM) real(rk) :: master_c(NDIM) real(rk) :: offset(NDIM) real(rk) :: normal_offset integer :: ierr call make_weighted_constraint(cons, ierr) call require_success(ierr, 40) slave_x = reshape((/ ZERO, ZERO, ZERO, & 2.0_rk, ZERO, ZERO /), (/ NDIM, 2 /)) master_x = reshape((/ ZERO, ONE, ZERO, & 2.0_rk, ONE, ZERO /), (/ NDIM, 2 /)) traction = (/ ZERO, ZERO, 3.0_rk /) call mortar_cons_force(cons, traction, slave_f, master_f, force_sum, ierr) call require_success(ierr, 41) call check_vec(force_sum, (/ ZERO, ZERO, ZERO /), 42) call check_close(slave_f(3,1), 1.125_rk, 43) call check_close(slave_f(3,2), 3.375_rk, 44) call check_close(master_f(3,1), -2.25_rk, 45) call check_close(master_f(3,2), -2.25_rk, 46) call mortar_cons_moment(cons, slave_x, master_x, traction, force_sum, & moment_sum, ierr) call require_success(ierr, 47) call check_vec(force_sum, (/ ZERO, ZERO, ZERO /), 48) call check_vec(moment_sum, (/ -4.5_rk, -2.25_rk, ZERO /), 49) call mortar_cons_centers(cons, slave_x, master_x, slave_c, master_c, & offset, normal_offset, ierr) call require_success(ierr, 50) call check_vec(slave_c, (/ 1.5_rk, ZERO, ZERO /), 51) call check_vec(master_c, (/ ONE, ONE, ZERO /), 52) call check_vec(offset, (/ 0.5_rk, -ONE, ZERO /), 53) call check_close(normal_offset, ZERO, 54) end subroutine check_force_and_moment subroutine check_normal_matrix() type(mortar_constraint) :: cons type(mortar_tangent_params) :: params type(mortar_tangent_diag) :: diag real(rk) :: k_local(MORTAR_TAN_MAX_DOF,MORTAR_TAN_MAX_DOF) real(rk) :: du(MORTAR_TAN_MAX_DOF) real(rk) :: force(MORTAR_TAN_MAX_DOF) real(rk) :: energy real(rk) :: row_norm real(rk) :: col_norm integer :: ndof integer :: ierr call make_basic_constraint(cons, ZERO, ierr) call require_success(ierr, 60) call mortar_tan_params_init(100.0_rk, ZERO, ZERO, 0.1_rk, params, ierr) call require_success(ierr, 61) call mortar_tan_matrix(cons, params, ndof, k_local, diag, ierr) call require_success(ierr, 62) if (ndof .ne. 6) call fail(63) call check_close(k_local(3,3), 100.0_rk, 64) call check_close(k_local(6,6), 100.0_rk, 65) call check_close(k_local(3,6), -100.0_rk, 66) call check_close(k_local(6,3), -100.0_rk, 67) call check_close(k_local(1,1), ZERO, 68) call check_close(diag%max_asym, ZERO, 69) call mortar_tan_row_balance(ndof, k_local, row_norm, col_norm, ierr) call require_success(ierr, 70) call check_close(row_norm, ZERO, 71) call check_close(col_norm, ZERO, 72) du = ZERO du(3) = 0.1_rk call mortar_tan_apply(ndof, k_local, du, force, energy, ierr) call require_success(ierr, 73) call check_close(force(3), 10.0_rk, 74) call check_close(force(6), -10.0_rk, 75) call check_close(energy, 0.5_rk, 76) end subroutine check_normal_matrix subroutine check_stick_friction() type(mortar_constraint) :: cons type(mortar_tangent_params) :: params type(mortar_tangent_diag) :: diag real(rk) :: k_local(MORTAR_TAN_MAX_DOF,MORTAR_TAN_MAX_DOF) real(rk) :: du(MORTAR_TAN_MAX_DOF) real(rk) :: force(MORTAR_TAN_MAX_DOF) real(rk) :: energy real(rk) :: max_diag real(rk) :: max_asym real(rk) :: trace real(rk) :: row_norm real(rk) :: energy_probe integer :: ndof integer :: diag_ndof integer :: ierr call make_basic_constraint(cons, 0.2_rk, ierr) call require_success(ierr, 80) call mortar_tan_params_init(100.0_rk, 30.0_rk, 0.5_rk, 0.1_rk, & params, ierr) call require_success(ierr, 81) call mortar_tan_matrix(cons, params, ndof, k_local, diag, ierr) call require_success(ierr, 82) call check_close(k_local(1,1), 30.0_rk, 83) call check_close(k_local(2,2), 30.0_rk, 84) call check_close(k_local(3,3), 100.0_rk, 85) call check_close(k_local(1,4), -30.0_rk, 86) call check_close(diag%friction_scale, ONE, 87) du = ZERO du(1) = 0.2_rk du(4) = -0.1_rk call mortar_tan_apply(ndof, k_local, du, force, energy, ierr) call require_success(ierr, 88) call check_close(force(1), 9.0_rk, 89) call check_close(force(4), -9.0_rk, 90) call check_close(energy, 1.35_rk, 91) call mortar_tan_diag_values(diag, diag_ndof, max_diag, max_asym, trace, & row_norm, energy_probe, ierr) call require_success(ierr, 92) if (diag_ndof .ne. ndof) call fail(93) call check_close(max_asym, ZERO, 94) if (max_diag .lt. 100.0_rk) call fail(95) if (trace .le. ZERO .or. energy_probe .lt. ZERO) call fail(96) call check_close(row_norm, ZERO, 97) end subroutine check_stick_friction subroutine check_weighted_matrix() type(mortar_constraint) :: cons type(mortar_tangent_params) :: params type(mortar_tangent_diag) :: diag real(rk) :: k_local(MORTAR_TAN_MAX_DOF,MORTAR_TAN_MAX_DOF) real(rk) :: row_norm real(rk) :: col_norm integer :: ndof integer :: ierr call make_weighted_constraint(cons, ierr) call require_success(ierr, 110) call mortar_tan_params_init(80.0_rk, 20.0_rk, 0.4_rk, 0.1_rk, params, & ierr) call require_success(ierr, 111) call mortar_tan_matrix(cons, params, ndof, k_local, diag, ierr) call require_success(ierr, 112) if (ndof .ne. 12) call fail(113) call check_close(k_local(3,3), 7.5_rk, 114) call check_close(k_local(3,6), 22.5_rk, 115) call check_close(k_local(3,9), -15.0_rk, 116) call check_close(k_local(3,12), -15.0_rk, 117) call check_close(diag%max_asym, ZERO, 118) call mortar_tan_row_balance(ndof, k_local, row_norm, col_norm, ierr) call require_success(ierr, 119) call check_close(row_norm, ZERO, 120) call check_close(col_norm, ZERO, 121) end subroutine check_weighted_matrix subroutine check_slip_nonsym() type(mortar_constraint) :: cons type(mortar_tangent_params) :: params type(mortar_tangent_diag) :: diag real(rk) :: k_local(MORTAR_TAN_MAX_DOF,MORTAR_TAN_MAX_DOF) real(rk) :: block(NDIM,NDIM) real(rk) :: fric_scale real(rk) :: slip_soft real(rk) :: max_asym integer :: ndof integer :: ierr call make_basic_constraint(cons, 0.2_rk, ierr) call require_success(ierr, 130) call mortar_tan_params_init(100.0_rk, 50.0_rk, 0.4_rk, 0.1_rk, params, & ierr) call require_success(ierr, 131) params%nonsym_scale = 0.2_rk call mortar_tan_params_valid(params, ierr) call require_success(ierr, 132) call mortar_tan_slip_matrix(cons, params, ndof, k_local, diag, ierr) call require_success(ierr, 133) if (ndof .ne. 6) call fail(134) if (diag%friction_scale .ge. ONE) call fail(135) if (diag%max_asym .le. ZERO) call fail(136) if (k_local(3,1) .le. ZERO) call fail(137) call mortar_tan_check_sym(ndof, k_local, max_asym, ierr) call require_success(ierr, 138) call check_close(max_asym, diag%max_asym, 139) call mortar_tan_block_values(cons, params, MORTAR_TAN_SLIP, block, & fric_scale, slip_soft, ierr) call require_success(ierr, 140) call check_close(fric_scale, ONE / 3.0_rk, 141) if (slip_soft .ge. block(2,2)) call fail(142) if (block(3,1) .le. ZERO .or. abs(block(1,3)) .gt. TOL) & call fail(143) end subroutine check_slip_nonsym subroutine check_projector_diag() type(mortar_tangent_params) :: params real(rk) :: normal(NDIM) real(rk) :: normal_proj(NDIM,NDIM) real(rk) :: tangent_proj(NDIM,NDIM) real(rk) :: pressure real(rk) :: normal_stiff real(rk) :: tangent_stiff integer :: ierr normal = (/ ZERO, ONE, ZERO /) call mortar_tan_projector(normal, normal_proj, tangent_proj, ierr) call require_success(ierr, 150) call check_close(normal_proj(2,2), ONE, 151) call check_close(normal_proj(1,1), ZERO, 152) call check_close(tangent_proj(1,1), ONE, 153) call check_close(tangent_proj(2,2), ZERO, 154) call check_close(tangent_proj(3,3), ONE, 155) call mortar_tan_params_init(100.0_rk, 25.0_rk, 0.3_rk, 0.1_rk, params, & ierr) call require_success(ierr, 156) call mortar_tan_pressure_parts(params, 0.2_rk, pressure, normal_stiff, & tangent_stiff, ierr) call require_success(ierr, 157) call check_close(pressure, 20.0_rk, 158) call check_close(normal_stiff, 100.0_rk, 159) call check_close(tangent_stiff, 25.0_rk, 160) call mortar_tan_pressure_parts(params, -0.2_rk, pressure, normal_stiff, & tangent_stiff, ierr) call require_success(ierr, 161) call check_close(pressure, ZERO, 162) call check_close(normal_stiff, ZERO, 163) call check_close(tangent_stiff, 25.0_rk, 164) end subroutine check_projector_diag subroutine check_error_paths() type(mortar_constraint) :: cons type(mortar_tangent_params) :: params type(mortar_tangent_diag) :: diag real(rk) :: k_small(3,3) real(rk) :: k_full(MORTAR_TAN_MAX_DOF,MORTAR_TAN_MAX_DOF) real(rk) :: du(1) real(rk) :: force(1) real(rk) :: energy real(rk) :: max_diag real(rk) :: max_asym real(rk) :: trace real(rk) :: row_norm real(rk) :: energy_probe integer :: ndof integer :: ierr call mortar_cons_init(1, 1, (/ 0.5_rk /), (/ ONE /), & (/ ZERO, ZERO, ONE /), ONE, ZERO, & (/ ZERO, ZERO, ZERO /), ZERO, cons, ierr) if (ierr .eq. FEM_SUCCESS) call fail(170) call mortar_cons_init(1, 1, (/ ONE /), (/ ONE /), & (/ ZERO, ZERO, 2.0_rk /), ONE, ZERO, & (/ ZERO, ZERO, ZERO /), ZERO, cons, ierr) if (ierr .eq. FEM_SUCCESS) call fail(171) call mortar_cons_init(1, 1, (/ ONE /), (/ ONE /), & (/ ZERO, ZERO, ONE /), -ONE, ZERO, & (/ ZERO, ZERO, ZERO /), ZERO, cons, ierr) if (ierr .eq. FEM_SUCCESS) call fail(172) call make_basic_constraint(cons, ZERO, ierr) call require_success(ierr, 173) call mortar_tan_params_init(ZERO, ZERO, ZERO, 0.1_rk, params, ierr) if (ierr .eq. FEM_SUCCESS) call fail(174) call mortar_tan_params_init(100.0_rk, 10.0_rk, 0.3_rk, 0.1_rk, params, & ierr) call require_success(ierr, 175) params%friction_reg = ZERO call mortar_tan_params_valid(params, ierr) if (ierr .eq. FEM_SUCCESS) call fail(176) call mortar_tan_params_init(100.0_rk, 10.0_rk, 0.3_rk, 0.1_rk, params, & ierr) call require_success(ierr, 177) call mortar_tan_matrix(cons, params, ndof, k_small, diag, ierr) if (ierr .eq. FEM_SUCCESS) call fail(178) call mortar_tan_apply(0, k_full, du, force, energy, ierr) if (ierr .eq. FEM_SUCCESS) call fail(179) call mortar_tan_diag_values(diag, ndof, max_diag, max_asym, trace, & row_norm, energy_probe, ierr) if (ierr .eq. FEM_SUCCESS) call fail(180) call mortar_tan_projector((/ ZERO, ZERO, 2.0_rk /), & k_full(1:3,1:3), k_full(4:6,4:6), ierr) if (ierr .eq. FEM_SUCCESS) call fail(181) end subroutine check_error_paths subroutine make_basic_constraint(cons, slip_x, ierr) type(mortar_constraint), intent(out) :: cons real(rk), intent(in) :: slip_x integer, intent(out) :: ierr call mortar_cons_init(1, 1, (/ ONE /), (/ ONE /), & (/ ZERO, ZERO, ONE /), ONE, 0.02_rk, & (/ slip_x, ZERO, ZERO /), ZERO, cons, ierr) end subroutine make_basic_constraint subroutine make_weighted_constraint(cons, ierr) type(mortar_constraint), intent(out) :: cons integer, intent(out) :: ierr call mortar_cons_init(2, 2, (/ 0.25_rk, 0.75_rk /), & (/ 0.5_rk, 0.5_rk /), (/ ZERO, ZERO, ONE /), & 1.5_rk, ZERO, (/ ZERO, ZERO, ZERO /), ZERO, & cons, ierr) end subroutine make_weighted_constraint 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(NDIM) real(rk), intent(in) :: expected(NDIM) 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_tangent failed:', code stop 1 end subroutine fail end program test_contact_mortar_tangent