Files
CCLite/tests/unit/test_geometry_primitives.f90
2026-07-05 23:55:23 +08:00

155 lines
7.7 KiB
Fortran

program test_geometry_primitives
use iso_c_binding, only: c_double
use ccl_errors, only: CCL_ERROR_INPUT_INVALID_VALUE, CCL_SUCCESS
use ccl_geometry, only: CCL_AABB_Type, CCL_Geometry_Diagnostics_Type, ccl_aabb_expand_point, &
ccl_aabb_init, ccl_aabb_overlap, ccl_facet_aabb, ccl_geometry_diagnostics_reset, &
ccl_particle_aabb, ccl_point_quad_closest, ccl_point_segment_closest, &
ccl_point_triangle_closest, ccl_triangle_barycentric, ccl_vec3_cross, ccl_vec3_dot, &
ccl_vec3_norm, ccl_vec3_normalize
implicit none
integer :: ierr
real(c_double) :: value
real(c_double) :: vector(3)
real(c_double) :: closest(3)
real(c_double) :: weights(3)
real(c_double) :: weights4(4)
real(c_double) :: distance2
real(c_double) :: t
real(c_double) :: quad(3, 4)
real(c_double) :: facet(3, 8)
type(CCL_AABB_Type) :: box_a
type(CCL_AABB_Type) :: box_b
type(CCL_Geometry_Diagnostics_Type) :: diagnostics
call require_real_close(ccl_vec3_dot([1.0_c_double, 2.0_c_double, 3.0_c_double], &
[4.0_c_double, 5.0_c_double, 6.0_c_double]), 32.0_c_double, "dot product")
call ccl_vec3_cross([1.0_c_double, 0.0_c_double, 0.0_c_double], &
[0.0_c_double, 1.0_c_double, 0.0_c_double], vector)
call require_vector_close(vector, [0.0_c_double, 0.0_c_double, 1.0_c_double], "cross product")
call require_real_close(ccl_vec3_norm([3.0_c_double, 4.0_c_double, 0.0_c_double]), &
5.0_c_double, "norm")
call ccl_geometry_diagnostics_reset(diagnostics)
call ccl_vec3_normalize([0.0_c_double, 0.0_c_double, 2.0_c_double], vector, ierr, diagnostics)
call require_equal(ierr, CCL_SUCCESS, "normalize valid vector")
call require_vector_close(vector, [0.0_c_double, 0.0_c_double, 1.0_c_double], "normalized vector")
call ccl_vec3_normalize([0.0_c_double, 0.0_c_double, 0.0_c_double], vector, ierr, diagnostics)
call require_equal(ierr, CCL_ERROR_INPUT_INVALID_VALUE, "zero normal rejected")
call require_equal(diagnostics%invalid_normal_count, 1, "invalid normal counted")
call ccl_aabb_init(box_a)
call ccl_aabb_expand_point(box_a, [0.0_c_double, 0.0_c_double, 0.0_c_double], ierr)
call require_equal(ierr, CCL_SUCCESS, "AABB first point")
call ccl_aabb_expand_point(box_a, [1.0_c_double, 1.0_c_double, 1.0_c_double], ierr)
call require_equal(ierr, CCL_SUCCESS, "AABB second point")
call ccl_particle_aabb([1.5_c_double, 0.5_c_double, 0.5_c_double], 0.6_c_double, box_b, ierr)
call require_equal(ierr, CCL_SUCCESS, "particle AABB")
call require_true(ccl_aabb_overlap(box_a, box_b), "touching AABBs overlap")
facet = 0.0_c_double
facet(:, 1) = [0.0_c_double, 0.0_c_double, 0.0_c_double]
facet(:, 2) = [1.0_c_double, 0.0_c_double, 0.0_c_double]
facet(:, 3) = [1.0_c_double, 1.0_c_double, 0.0_c_double]
facet(:, 4) = [0.0_c_double, 1.0_c_double, 0.0_c_double]
call ccl_facet_aabb(facet, 4, 0.1_c_double, box_a, ierr)
call require_equal(ierr, CCL_SUCCESS, "facet AABB")
call require_real_close(box_a%min_corner(1), -0.1_c_double, "facet AABB padding")
call ccl_geometry_diagnostics_reset(diagnostics)
call ccl_point_segment_closest([0.5_c_double, 1.0_c_double, 0.0_c_double], &
[0.0_c_double, 0.0_c_double, 0.0_c_double], [1.0_c_double, 0.0_c_double, 0.0_c_double], &
closest, t, distance2, ierr, diagnostics)
call require_equal(ierr, CCL_SUCCESS, "segment closest")
call require_real_close(t, 0.5_c_double, "segment parameter")
call require_vector_close(closest, [0.5_c_double, 0.0_c_double, 0.0_c_double], "segment closest point")
call ccl_point_segment_closest([0.0_c_double, 0.0_c_double, 0.0_c_double], &
[1.0_c_double, 1.0_c_double, 1.0_c_double], [1.0_c_double, 1.0_c_double, 1.0_c_double], &
closest, t, distance2, ierr, diagnostics)
call require_equal(ierr, CCL_ERROR_INPUT_INVALID_VALUE, "degenerate segment rejected")
call require_equal(diagnostics%degenerate_edge_count, 1, "degenerate edge counted")
call ccl_point_triangle_closest([0.25_c_double, 0.25_c_double, 1.0_c_double], &
[0.0_c_double, 0.0_c_double, 0.0_c_double], [1.0_c_double, 0.0_c_double, 0.0_c_double], &
[0.0_c_double, 1.0_c_double, 0.0_c_double], closest, weights, distance2, ierr, diagnostics)
call require_equal(ierr, CCL_SUCCESS, "triangle closest inside")
call require_vector_close(closest, [0.25_c_double, 0.25_c_double, 0.0_c_double], "triangle closest point")
call require_real_close(sum(weights), 1.0_c_double, "triangle weights sum")
call require_real_close(distance2, 1.0_c_double, "triangle distance2")
call ccl_point_triangle_closest([2.0_c_double, 0.0_c_double, 0.0_c_double], &
[0.0_c_double, 0.0_c_double, 0.0_c_double], [1.0_c_double, 0.0_c_double, 0.0_c_double], &
[0.0_c_double, 1.0_c_double, 0.0_c_double], closest, weights, distance2, ierr, diagnostics)
call require_equal(ierr, CCL_SUCCESS, "triangle closest vertex")
call require_vector_close(closest, [1.0_c_double, 0.0_c_double, 0.0_c_double], "triangle vertex point")
call ccl_triangle_barycentric([0.2_c_double, 0.3_c_double, 0.0_c_double], &
[0.0_c_double, 0.0_c_double, 0.0_c_double], [1.0_c_double, 0.0_c_double, 0.0_c_double], &
[0.0_c_double, 1.0_c_double, 0.0_c_double], weights, ierr, diagnostics)
call require_equal(ierr, CCL_SUCCESS, "barycentric valid")
call require_real_close(sum(weights), 1.0_c_double, "barycentric weight sum")
call require_real_close(weights(1), 0.5_c_double, "barycentric first weight")
quad(:, 1) = [0.0_c_double, 0.0_c_double, 0.0_c_double]
quad(:, 2) = [1.0_c_double, 0.0_c_double, 0.0_c_double]
quad(:, 3) = [1.0_c_double, 1.0_c_double, 0.0_c_double]
quad(:, 4) = [0.0_c_double, 1.0_c_double, 0.0_c_double]
call ccl_point_quad_closest([0.75_c_double, 0.75_c_double, 0.5_c_double], quad, &
closest, weights4, distance2, ierr, diagnostics)
call require_equal(ierr, CCL_SUCCESS, "quad closest")
call require_real_close(sum(weights4), 1.0_c_double, "quad weights sum")
call require_real_close(distance2, 0.25_c_double, "quad distance2")
call ccl_point_triangle_closest([0.0_c_double, 0.0_c_double, 0.0_c_double], &
[0.0_c_double, 0.0_c_double, 0.0_c_double], [1.0_c_double, 0.0_c_double, 0.0_c_double], &
[2.0_c_double, 0.0_c_double, 0.0_c_double], closest, weights, distance2, ierr, diagnostics)
call require_equal(ierr, CCL_ERROR_INPUT_INVALID_VALUE, "degenerate triangle rejected")
call require_true(diagnostics%degenerate_triangle_count >= 1, "degenerate triangle counted")
contains
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
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_geometry_primitives