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