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

428 lines
16 KiB
Fortran

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