108 lines
4.9 KiB
Fortran
108 lines
4.9 KiB
Fortran
program test_broad_phase
|
|
use iso_c_binding, only: c_double
|
|
use ccl_broad_phase, only: CCL_Broad_Phase_Stats_Type, CCL_Candidate_Pair_Type, &
|
|
CCL_Hash_Grid_Type, ccl_broad_phase_stats_reset, ccl_hash_grid_init, &
|
|
ccl_hash_grid_insert_facet, ccl_hash_grid_query_particle
|
|
use ccl_errors, only: CCL_ERROR_INPUT_INVALID_VALUE, CCL_SUCCESS
|
|
use ccl_geometry, only: CCL_AABB_Type, ccl_aabb_init, ccl_aabb_expand_point, ccl_particle_aabb
|
|
implicit none
|
|
|
|
integer :: ierr
|
|
integer :: candidate_count
|
|
type(CCL_Hash_Grid_Type) :: grid
|
|
type(CCL_Broad_Phase_Stats_Type) :: stats
|
|
type(CCL_AABB_Type) :: facet_box
|
|
type(CCL_AABB_Type) :: particle_box
|
|
type(CCL_Candidate_Pair_Type) :: candidates(4)
|
|
|
|
call ccl_hash_grid_init(grid, 1.0_c_double, 16, ierr)
|
|
call require_equal(ierr, CCL_SUCCESS, "grid init")
|
|
call ccl_broad_phase_stats_reset(stats)
|
|
|
|
call make_box([0.0_c_double, 0.0_c_double, 0.0_c_double], &
|
|
[1.0_c_double, 1.0_c_double, 0.0_c_double], facet_box)
|
|
call ccl_hash_grid_insert_facet(grid, 1, facet_box, stats, ierr)
|
|
call require_equal(ierr, CCL_SUCCESS, "facet insert")
|
|
call require_true(stats%facet_insert_count > 0, "facet insertion counted")
|
|
call require_true(stats%grid_cell_count > 0, "grid cells counted")
|
|
|
|
call ccl_particle_aabb([0.5_c_double, 0.5_c_double, 0.0_c_double], 0.1_c_double, particle_box, ierr)
|
|
call require_equal(ierr, CCL_SUCCESS, "particle AABB near facet")
|
|
candidate_count = 0
|
|
call ccl_hash_grid_query_particle(grid, 1, particle_box, candidates, candidate_count, 4, stats, ierr)
|
|
call require_equal(ierr, CCL_SUCCESS, "near particle query")
|
|
call require_equal(candidate_count, 1, "near particle candidate count")
|
|
call require_equal(candidates(1)%particle_index, 1, "candidate particle id")
|
|
call require_equal(candidates(1)%facet_index, 1, "candidate facet id")
|
|
|
|
call ccl_particle_aabb([5.0_c_double, 5.0_c_double, 0.0_c_double], 0.1_c_double, particle_box, ierr)
|
|
call require_equal(ierr, CCL_SUCCESS, "particle AABB far")
|
|
candidate_count = 0
|
|
call ccl_hash_grid_query_particle(grid, 2, particle_box, candidates, candidate_count, 4, stats, ierr)
|
|
call require_equal(ierr, CCL_SUCCESS, "far particle query")
|
|
call require_equal(candidate_count, 0, "far particle has no candidate")
|
|
|
|
call ccl_hash_grid_init(grid, 1.0_c_double, 16, ierr)
|
|
call require_equal(ierr, CCL_SUCCESS, "boundary grid init")
|
|
call ccl_broad_phase_stats_reset(stats)
|
|
call make_box([0.9_c_double, 0.0_c_double, 0.0_c_double], &
|
|
[1.1_c_double, 0.2_c_double, 0.0_c_double], facet_box)
|
|
call ccl_hash_grid_insert_facet(grid, 3, facet_box, stats, ierr)
|
|
call require_equal(ierr, CCL_SUCCESS, "boundary facet insert")
|
|
call ccl_particle_aabb([1.0_c_double, 0.1_c_double, 0.0_c_double], 0.05_c_double, particle_box, ierr)
|
|
candidate_count = 0
|
|
call ccl_hash_grid_query_particle(grid, 3, particle_box, candidates, candidate_count, 4, stats, ierr)
|
|
call require_equal(ierr, CCL_SUCCESS, "boundary particle query")
|
|
call require_equal(candidate_count, 1, "boundary candidate deduplicated")
|
|
call require_true(stats%duplicate_candidate_count >= 1, "duplicate candidate counted")
|
|
|
|
call ccl_hash_grid_init(grid, 1.0_c_double, 16, ierr)
|
|
call ccl_broad_phase_stats_reset(stats)
|
|
call make_box([0.0_c_double, 0.0_c_double, 0.0_c_double], &
|
|
[0.2_c_double, 0.2_c_double, 0.0_c_double], facet_box)
|
|
call ccl_hash_grid_insert_facet(grid, 4, facet_box, stats, ierr)
|
|
call require_equal(ierr, CCL_SUCCESS, "overflow facet insert")
|
|
call ccl_particle_aabb([0.1_c_double, 0.1_c_double, 0.0_c_double], 0.05_c_double, particle_box, ierr)
|
|
candidate_count = 0
|
|
call ccl_hash_grid_query_particle(grid, 4, particle_box, candidates, candidate_count, 0, stats, ierr)
|
|
call require_equal(ierr, CCL_ERROR_INPUT_INVALID_VALUE, "candidate overflow rejected")
|
|
call require_equal(stats%overflow_count, 1, "candidate overflow counted")
|
|
|
|
contains
|
|
|
|
subroutine make_box(min_corner, max_corner, box)
|
|
real(c_double), intent(in) :: min_corner(3)
|
|
real(c_double), intent(in) :: max_corner(3)
|
|
type(CCL_AABB_Type), intent(out) :: box
|
|
integer :: local_ierr
|
|
|
|
call ccl_aabb_init(box)
|
|
call ccl_aabb_expand_point(box, min_corner, local_ierr)
|
|
call require_equal(local_ierr, CCL_SUCCESS, "box min point")
|
|
call ccl_aabb_expand_point(box, max_corner, local_ierr)
|
|
call require_equal(local_ierr, CCL_SUCCESS, "box max point")
|
|
end subroutine make_box
|
|
|
|
subroutine require_equal(actual, expected, message)
|
|
integer, intent(in) :: actual
|
|
integer, intent(in) :: expected
|
|
character(len=*), intent(in) :: message
|
|
|
|
if (actual /= expected) then
|
|
print '(a,": expected ",i0," got ",i0)', trim(message), expected, actual
|
|
stop 1
|
|
end if
|
|
end subroutine require_equal
|
|
|
|
subroutine require_true(condition, message)
|
|
logical, intent(in) :: condition
|
|
character(len=*), intent(in) :: message
|
|
|
|
if (.not. condition) then
|
|
print '(a)', trim(message)
|
|
stop 1
|
|
end if
|
|
end subroutine require_true
|
|
|
|
end program test_broad_phase
|