Files
CCLite/tests/unit/test_contact_narrow.f90
T
2026-07-06 00:01:54 +08:00

148 lines
6.3 KiB
Fortran

program test_contact_narrow
use iso_c_binding, only: c_double, c_int32_t, c_int64_t
use ccl_broad_phase, only: CCL_Candidate_Pair_Type
use ccl_contact_narrow, only: CCL_Contact_Record_Type, CCL_Narrow_Phase_Stats_Type, &
ccl_contact_report_write_csv, ccl_narrow_phase_run, ccl_narrow_phase_stats_reset
use ccl_errors, only: CCL_SUCCESS
use ccl_interface_view, only: CCL_FEM_Facet_View_Type, CCL_SPH_Particle_View_Type
implicit none
integer :: ierr
integer :: contact_count
type(CCL_SPH_Particle_View_Type) :: particles(2)
type(CCL_FEM_Facet_View_Type) :: facets(2)
type(CCL_Candidate_Pair_Type) :: candidates(2)
type(CCL_Contact_Record_Type) :: contacts(4)
type(CCL_Narrow_Phase_Stats_Type) :: stats
call make_particle(particles(1), 101_c_int64_t, [0.25_c_double, 0.25_c_double, 0.10_c_double], &
0.20_c_double)
call make_particle(particles(2), 102_c_int64_t, [0.25_c_double, 0.25_c_double, 1.00_c_double], &
0.20_c_double)
call make_quad_facet(facets(1), 201_c_int64_t)
call make_degenerate_facet(facets(2), 202_c_int64_t)
candidates(1)%particle_index = 1
candidates(1)%facet_index = 1
call ccl_narrow_phase_stats_reset(stats)
call ccl_narrow_phase_run(3_c_int32_t, 7_c_int32_t, particles, 2, facets, 2, candidates, 1, &
contacts, contact_count, 4, stats, ierr)
call require_equal(ierr, CCL_SUCCESS, "penetrating candidate accepted")
call require_equal(contact_count, 1, "one contact generated")
call require_equal(stats%contact_count, 1, "contact count tracked")
call require_real_close(contacts(1)%gap, 0.10_c_double, "gap")
call require_real_close(contacts(1)%penetration, 0.10_c_double, "penetration")
call require_vector_close(contacts(1)%normal, [0.0_c_double, 0.0_c_double, 1.0_c_double], "normal")
call require_real_close(sum(contacts(1)%shape_weights(1:4)), 1.0_c_double, "shape weight sum")
candidates(1)%particle_index = 2
candidates(1)%facet_index = 1
call ccl_narrow_phase_stats_reset(stats)
call ccl_narrow_phase_run(3_c_int32_t, 7_c_int32_t, particles, 2, facets, 2, candidates, 1, &
contacts, contact_count, 4, stats, ierr)
call require_equal(ierr, CCL_SUCCESS, "separated candidate accepted")
call require_equal(contact_count, 0, "no contact for separated particle")
call require_equal(stats%skipped_separated_count, 1, "separated skip counted")
candidates(1)%particle_index = 1
candidates(1)%facet_index = 2
call ccl_narrow_phase_stats_reset(stats)
call ccl_narrow_phase_run(3_c_int32_t, 7_c_int32_t, particles, 2, facets, 2, candidates, 1, &
contacts, contact_count, 4, stats, ierr)
call require_equal(ierr, CCL_SUCCESS, "degenerate candidate skipped")
call require_equal(contact_count, 0, "no contact for degenerate facet")
call require_equal(stats%skipped_degenerate_count, 1, "degenerate skip counted")
candidates(1)%particle_index = 1
candidates(1)%facet_index = 1
call ccl_narrow_phase_stats_reset(stats)
call ccl_narrow_phase_run(3_c_int32_t, 7_c_int32_t, particles, 2, facets, 2, candidates, 1, &
contacts, contact_count, 4, stats, ierr)
call require_equal(ierr, CCL_SUCCESS, "contact before report")
call ccl_contact_report_write_csv("v020_contact_report_unit.csv", contacts, contact_count, ierr)
call require_equal(ierr, CCL_SUCCESS, "contact report csv written")
contains
subroutine make_particle(particle, external_id, x, radius)
type(CCL_SPH_Particle_View_Type), intent(out) :: particle
integer(c_int64_t), intent(in) :: external_id
real(c_double), intent(in) :: x(3)
real(c_double), intent(in) :: radius
particle = CCL_SPH_Particle_View_Type()
particle%external_id = external_id
particle%internal_index = int(external_id - 100_c_int64_t, c_int32_t)
particle%status = 1_c_int32_t
particle%valid_flags = 1_c_int32_t
particle%contact_radius = radius
particle%mass = 1.0_c_double
particle%x = x
particle%v = 0.0_c_double
end subroutine make_particle
subroutine make_quad_facet(facet, facet_id)
type(CCL_FEM_Facet_View_Type), intent(out) :: facet
integer(c_int64_t), intent(in) :: facet_id
facet = CCL_FEM_Facet_View_Type()
facet%facet_id = facet_id
facet%node_count = 4_c_int32_t
facet%node_ids(1:4) = [201_c_int64_t, 202_c_int64_t, 203_c_int64_t, 204_c_int64_t]
facet%area = 1.0_c_double
facet%thickness = 0.0_c_double
facet%normal = [0.0_c_double, 0.0_c_double, 1.0_c_double]
facet%x(:, 1) = [0.0_c_double, 0.0_c_double, 0.0_c_double]
facet%x(:, 2) = [1.0_c_double, 0.0_c_double, 0.0_c_double]
facet%x(:, 3) = [1.0_c_double, 1.0_c_double, 0.0_c_double]
facet%x(:, 4) = [0.0_c_double, 1.0_c_double, 0.0_c_double]
facet%v = 0.0_c_double
facet%valid_flags = 1_c_int32_t
end subroutine make_quad_facet
subroutine make_degenerate_facet(facet, facet_id)
type(CCL_FEM_Facet_View_Type), intent(out) :: facet
integer(c_int64_t), intent(in) :: facet_id
call make_quad_facet(facet, facet_id)
facet%x(:, 1) = [0.0_c_double, 0.0_c_double, 0.0_c_double]
facet%x(:, 2) = [1.0_c_double, 0.0_c_double, 0.0_c_double]
facet%x(:, 3) = [2.0_c_double, 0.0_c_double, 0.0_c_double]
facet%x(:, 4) = [3.0_c_double, 0.0_c_double, 0.0_c_double]
end subroutine make_degenerate_facet
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_real_close(actual, expected, message)
real(c_double), intent(in) :: actual
real(c_double), intent(in) :: expected
character(len=*), intent(in) :: message
if (abs(actual - expected) > 1.0e-10_c_double) then
print '(a,": expected ",es12.4," got ",es12.4)', trim(message), expected, actual
stop 1
end if
end subroutine require_real_close
subroutine require_vector_close(actual, expected, message)
real(c_double), intent(in) :: actual(3)
real(c_double), intent(in) :: expected(3)
character(len=*), intent(in) :: message
if (maxval(abs(actual - expected)) > 1.0e-10_c_double) then
print '(a,": vector mismatch")', trim(message)
stop 1
end if
end subroutine require_vector_close
end program test_contact_narrow