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

344 lines
13 KiB
Fortran

program test_particle_coupling
use fem_precision
use fem_error
use fem_particle_state
use fem_particle_search
use fem_particle_contact
use fem_particle_metrics
implicit none
real(rk), parameter :: TOL = 1.0e-10_rk
call check_particle_state()
call check_pair_search()
call check_pair_contact()
call check_wall_contact()
call check_metrics()
call check_error_paths()
contains
subroutine check_particle_state()
integer :: slot
integer :: ext_id
integer :: active_count
integer :: ierr
logical :: active
real(rk) :: position(3)
real(rk) :: velocity(3)
real(rk) :: force(3)
real(rk) :: radius
real(rk) :: mass
real(rk) :: energy
real(rk) :: momentum(3)
real(rk) :: total_mass
real(rk) :: min_corner(3)
real(rk) :: max_corner(3)
real(rk) :: min_radius
real(rk) :: max_radius
call particle_reset()
call particle_add(101, (/ ZERO, ZERO, ONE /), (/ ONE, ZERO, ZERO /), &
0.25_rk, 2.0_rk, slot, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(10)
if (slot .ne. 1) call fail(11)
if (particle_find_id(101) .ne. 1) call fail(12)
call particle_get(1, ext_id, active, position, velocity, radius, mass, &
force, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(13)
if (ext_id .ne. 101 .or. .not. active) call fail(14)
call check_vec(position, (/ ZERO, ZERO, ONE /), 15)
call check_vec(velocity, (/ ONE, ZERO, ZERO /), 16)
call check_close(radius, 0.25_rk, 17)
call check_close(mass, 2.0_rk, 18)
call particle_add_force(1, (/ ZERO, ZERO, 2.0_rk /), ierr)
if (ierr .ne. FEM_SUCCESS) call fail(19)
call particle_integrate(0.5_rk, ZERO, (/ ZERO, ZERO, -ONE /), ierr)
if (ierr .ne. FEM_SUCCESS) call fail(20)
call particle_get(1, ext_id, active, position, velocity, radius, mass, &
force, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(21)
call check_vec(velocity, (/ ONE, ZERO, ZERO /), 22)
call check_vec(position, (/ 0.5_rk, ZERO, ONE /), 23)
call particle_kinetic_energy(energy, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(24)
call check_close(energy, ONE, 25)
call particle_momentum(momentum, total_mass, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(26)
call check_vec(momentum, (/ 2.0_rk, ZERO, ZERO /), 27)
call check_close(total_mass, 2.0_rk, 28)
call particle_bounds(min_corner, max_corner, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(29)
call check_vec(min_corner, (/ 0.25_rk, -0.25_rk, 0.75_rk /), 30)
call check_vec(max_corner, (/ 0.75_rk, 0.25_rk, 1.25_rk /), 31)
call particle_stats(active_count, total_mass, min_radius, max_radius, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(32)
if (active_count .ne. 1) call fail(33)
call check_close(min_radius, 0.25_rk, 34)
call check_close(max_radius, 0.25_rk, 35)
end subroutine check_particle_state
subroutine check_pair_search()
integer :: s1
integer :: s2
integer :: s3
integer :: pairs_i(4)
integer :: pairs_j(4)
integer :: pair_count
integer :: index(3)
integer :: ierr
real(rk) :: gap
real(rk) :: overlap
real(rk) :: max_overlap
real(rk) :: normal(3)
real(rk) :: rel_velocity(3)
real(rk) :: search_radius
call particle_reset()
call particle_add(1, (/ ZERO, ZERO, ZERO /), (/ ZERO, ZERO, ZERO /), &
0.50_rk, ONE, s1, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(50)
call particle_add(2, (/ 0.80_rk, ZERO, ZERO /), &
(/ ZERO, ZERO, ZERO /), 0.50_rk, ONE, s2, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(51)
call particle_add(3, (/ 3.00_rk, ZERO, ZERO /), &
(/ ZERO, ZERO, ZERO /), 0.25_rk, ONE, s3, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(52)
call particle_pair_measure(s1, s2, gap, normal, overlap, rel_velocity, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(53)
call check_close(gap, -0.20_rk, 54)
call check_close(overlap, 0.20_rk, 55)
call check_vec(normal, (/ ONE, ZERO, ZERO /), 56)
call check_vec(rel_velocity, (/ ZERO, ZERO, ZERO /), 57)
call particle_pairs_naive(4, pairs_i, pairs_j, 0.05_rk, pair_count, &
max_overlap, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(58)
if (pair_count .ne. 1) call fail(59)
if (pairs_i(1) .ne. s1 .or. pairs_j(1) .ne. s2) call fail(60)
call check_close(max_overlap, 0.20_rk, 61)
call particle_cell_index((/ -0.2_rk, 2.1_rk, ZERO /), &
(/ ZERO, ZERO, ZERO /), ONE, index, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(62)
if (index(1) .ne. -1 .or. index(2) .ne. 2 .or. index(3) .ne. 0) then
call fail(63)
end if
call particle_search_radius(0.10_rk, search_radius, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(64)
call check_close(search_radius, 1.10_rk, 65)
end subroutine check_pair_search
subroutine check_pair_contact()
type(particle_contact_params) :: params
integer :: s1
integer :: s2
integer :: ierr
real(rk) :: force_i(3)
real(rk) :: force_j(3)
real(rk) :: normal(3)
real(rk) :: overlap
real(rk) :: normal_speed
real(rk) :: slip_speed
real(rk) :: elastic_energy
real(rk) :: dissipated_power
real(rk) :: reduced_mass
real(rk) :: applied_overlap
integer :: ext_id
logical :: active
real(rk) :: position(3)
real(rk) :: velocity(3)
real(rk) :: radius
real(rk) :: mass
real(rk) :: force(3)
call particle_reset()
call particle_add(1, (/ ZERO, ZERO, ZERO /), (/ ZERO, ZERO, ZERO /), &
0.50_rk, 2.0_rk, s1, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(80)
call particle_add(2, (/ 0.75_rk, ZERO, ZERO /), (/ -ONE, 2.0_rk, ZERO /), &
0.50_rk, 3.0_rk, s2, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(81)
call particle_contact_init(1000.0_rk, 10.0_rk, 20.0_rk, 0.5_rk, &
2000.0_rk, 5.0_rk, params, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(82)
call particle_pair_force(s1, s2, params, force_i, force_j, normal, &
overlap, normal_speed, slip_speed, &
elastic_energy, dissipated_power, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(83)
call check_close(overlap, 0.25_rk, 84)
call check_vec(normal, (/ ONE, ZERO, ZERO /), 85)
call check_close(normal_speed, -ONE, 86)
call check_close(slip_speed, 2.0_rk, 87)
call check_vec(force_i + force_j, (/ ZERO, ZERO, ZERO /), 88)
call check_close(force_j(1), 260.0_rk, 89)
call check_close(force_j(2), -40.0_rk, 90)
call check_close(elastic_energy, 31.25_rk, 91)
if (dissipated_power .le. ZERO) call fail(92)
call particle_reduced_mass(2.0_rk, 3.0_rk, reduced_mass, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(93)
call check_close(reduced_mass, 1.2_rk, 94)
call particle_apply_pair(s1, s2, params, applied_overlap, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(95)
call check_close(applied_overlap, 0.25_rk, 96)
call particle_get(s2, ext_id, active, position, velocity, radius, mass, &
force, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(97)
call check_close(force(1), 260.0_rk, 98)
call check_close(force(2), -40.0_rk, 99)
end subroutine check_pair_contact
subroutine check_wall_contact()
type(particle_contact_params) :: params
integer :: slot
integer :: ierr
integer :: ext_id
logical :: active
real(rk) :: force(3)
real(rk) :: stored_force(3)
real(rk) :: overlap
real(rk) :: normal_speed
real(rk) :: elastic_energy
real(rk) :: dissipated_power
real(rk) :: position(3)
real(rk) :: velocity(3)
real(rk) :: radius
real(rk) :: mass
call particle_reset()
call particle_add(10, (/ ZERO, ZERO, 0.40_rk /), (/ ZERO, ZERO, -2.0_rk /), &
0.50_rk, ONE, slot, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(120)
call particle_contact_init(1000.0_rk, 10.0_rk, 20.0_rk, 0.5_rk, &
2000.0_rk, 5.0_rk, params, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(121)
call particle_wall_force(slot, (/ ZERO, ZERO, ZERO /), &
(/ ZERO, ZERO, ONE /), params, force, overlap, &
normal_speed, elastic_energy, dissipated_power, &
ierr)
if (ierr .ne. FEM_SUCCESS) call fail(122)
call check_close(overlap, 0.10_rk, 123)
call check_close(normal_speed, -2.0_rk, 124)
call check_vec(force, (/ ZERO, ZERO, 210.0_rk /), 125)
call check_close(elastic_energy, 10.0_rk, 126)
call check_close(dissipated_power, 20.0_rk, 127)
call particle_apply_wall(slot, (/ ZERO, ZERO, ZERO /), &
(/ ZERO, ZERO, ONE /), params, overlap, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(128)
call particle_get(slot, ext_id, active, position, velocity, radius, mass, &
stored_force, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(129)
call check_vec(stored_force, (/ ZERO, ZERO, 210.0_rk /), 130)
end subroutine check_wall_contact
subroutine check_metrics()
type(particle_metrics_state) :: state
type(particle_metrics_state) :: other
type(particle_metrics_state) :: merged
integer :: contact_count
integer :: ierr
real(rk) :: max_overlap
real(rk) :: total_energy
real(rk) :: momentum_norm
call particle_metrics_reset(state)
call particle_metrics_set_cloud(state, 3, 4.0_rk, 5.0_rk, &
(/ 3.0_rk, 4.0_rk, ZERO /), ierr)
if (ierr .ne. FEM_SUCCESS) call fail(150)
call particle_metrics_add_pair(state, 0.2_rk, 10.0_rk, 0.5_rk, &
0.1_rk, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(151)
call particle_metrics_add_wall(state, 0.1_rk, 4.0_rk, 0.2_rk, &
0.3_rk, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(152)
call particle_metrics_summary(state, contact_count, max_overlap, &
total_energy, momentum_norm, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(153)
if (contact_count .ne. 2) call fail(154)
call check_close(max_overlap, 0.2_rk, 155)
call check_close(total_energy, 5.7_rk, 156)
call check_close(momentum_norm, 5.0_rk, 157)
call particle_metrics_reset(other)
call particle_metrics_add_pair(other, 0.3_rk, 2.0_rk, 0.4_rk, ZERO, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(158)
call particle_metrics_merge(state, other, merged, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(159)
call particle_metrics_summary(merged, contact_count, max_overlap, &
total_energy, momentum_norm, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(160)
if (contact_count .ne. 3) call fail(161)
call check_close(max_overlap, 0.3_rk, 162)
call check_close(total_energy, 6.1_rk, 163)
end subroutine check_metrics
subroutine check_error_paths()
type(particle_contact_params) :: params
type(particle_metrics_state) :: metrics
integer :: slot
integer :: ierr
integer :: pairs_i(1)
integer :: pairs_j(1)
integer :: pair_count
real(rk) :: max_overlap
real(rk) :: overlap
call particle_reset()
call particle_add(-1, (/ ZERO, ZERO, ZERO /), (/ ZERO, ZERO, ZERO /), &
ONE, ONE, slot, ierr)
if (ierr .eq. FEM_SUCCESS) call fail(180)
call particle_add(1, (/ ZERO, ZERO, ZERO /), (/ ZERO, ZERO, ZERO /), &
ZERO, ONE, slot, ierr)
if (ierr .eq. FEM_SUCCESS) call fail(181)
call particle_add(1, (/ ZERO, ZERO, ZERO /), (/ ZERO, ZERO, ZERO /), &
ONE, ONE, slot, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(182)
call particle_add(1, (/ 2.0_rk, ZERO, ZERO /), &
(/ ZERO, ZERO, ZERO /), ONE, ONE, slot, ierr)
if (ierr .eq. FEM_SUCCESS) call fail(183)
call particle_pairs_naive(1, pairs_i, pairs_j, -ONE, pair_count, &
max_overlap, ierr)
if (ierr .eq. FEM_SUCCESS) call fail(184)
call particle_contact_init(ZERO, ZERO, ZERO, ZERO, ONE, ZERO, params, ierr)
if (ierr .eq. FEM_SUCCESS) call fail(185)
call particle_contact_init(ONE, ZERO, ZERO, ZERO, ONE, ZERO, params, ierr)
if (ierr .ne. FEM_SUCCESS) call fail(186)
call particle_apply_wall(9, (/ ZERO, ZERO, ZERO /), &
(/ ZERO, ZERO, ONE /), params, overlap, ierr)
if (ierr .eq. FEM_SUCCESS) call fail(187)
call particle_metrics_reset(metrics)
call particle_metrics_add_pair(metrics, -ONE, ZERO, ZERO, ZERO, ierr)
if (ierr .eq. FEM_SUCCESS) call fail(188)
end subroutine check_error_paths
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 fail(code)
integer, intent(in) :: code
write(*,*) 'test_particle_coupling failed:', code
stop 1
end subroutine fail
end program test_particle_coupling