344 lines
13 KiB
Fortran
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
|