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