program test_particle_fem_coupling use fem_precision use fem_error use fem_api use fem_particle_state use fem_particle_contact use fem_particle_facet_step use fem_particle_coupling implicit none integer, parameter :: MAXF = 16 integer, parameter :: MAXN = 8 real(rk), parameter :: TOL = 1.0e-9_rk call check_direct_nodal_loads() call check_collect_then_apply() call check_apply_all() call check_scan_preserves_forces() call check_collect_all_loads() call check_error_paths() contains subroutine check_direct_nodal_loads() integer :: nfacet integer :: max_nodes integer :: bottom integer :: ierr integer :: one_id(1) integer :: one_nnode(1) real(rk) :: load_vec(NDIM) real(rk) :: expected(NDIM) real(rk) :: total(NDIM) real(rk) :: node_loads(NDIM,MAXN,1) integer :: facet_id(MAXF) integer :: facet_nnode(MAXF) real(rk) :: coords(NDIM,MAXN,MAXF) real(rk) :: normals(NDIM,MAXF) call setup_model(nfacet, max_nodes, facet_id, facet_nnode, coords, & normals) bottom = find_down_facet(nfacet, normals) if (bottom .le. 0) call fail(10) load_vec = (/ 3.0_rk, -4.0_rk, 5.0_rk /) node_loads = ZERO call fill_uniform_load(facet_nnode(bottom), load_vec, node_loads(:,:,1)) one_id(1) = facet_id(bottom) one_nnode(1) = facet_nnode(bottom) call fem_clear_sph_forces(ierr) if (ierr .ne. FEM_SUCCESS) call fail(11) call fem_apply_sph_facet_nodal_loads(1, MAXN, one_id, one_nnode, & node_loads, ierr) if (ierr .ne. FEM_SUCCESS) call fail(12) call fem_get_sph_force_summary(total, ierr) if (ierr .ne. FEM_SUCCESS) call fail(13) expected = load_vec * real(facet_nnode(bottom), rk) call check_vec(total, expected, 14) one_nnode(1) = one_nnode(1) + 1 call fem_apply_sph_facet_nodal_loads(1, MAXN, one_id, one_nnode, & node_loads, ierr) if (ierr .eq. FEM_SUCCESS) call fail(15) call teardown_model() end subroutine check_direct_nodal_loads subroutine check_collect_then_apply() type(particle_contact_params) :: params type(pfacet_step_stats) :: stats integer :: nfacet integer :: max_nodes integer :: bottom integer :: ierr integer :: slot integer :: slots(1) integer :: out_id(MAXF) integer :: out_nnode(MAXF) integer :: facet_id(MAXF) integer :: facet_nnode(MAXF) real(rk) :: coords(NDIM,MAXN,MAXF) real(rk) :: normals(NDIM,MAXF) real(rk) :: node_loads(NDIM,MAXN,MAXF) real(rk) :: centroid(NDIM) real(rk) :: expected_fem(NDIM) real(rk) :: total_load(NDIM) real(rk) :: total_force(NDIM) real(rk) :: particle_force(NDIM) call setup_model(nfacet, max_nodes, facet_id, facet_nnode, coords, & normals) call setup_contact_particle(nfacet, facet_nnode, coords, normals, bottom, & centroid, slot, params) slots(1) = slot call fem_clear_sph_forces(ierr) if (ierr .ne. FEM_SUCCESS) call fail(30) call particle_fem_collect_loads(1, slots, params, .true., MAXF, MAXN, & out_id, out_nnode, node_loads, stats, & ierr) if (ierr .ne. FEM_SUCCESS) call fail(31) expected_fem = -100.0_rk * normals(:,bottom) call sum_all_loads(MAXF, MAXN, node_loads, total_load) call check_vec(total_load, expected_fem, 32) call check_step_stats(stats, 1, 1, 0.10_rk, 5.0_rk, 100.0_rk, 33) call get_particle_force(slot, particle_force) call check_vec(particle_force, 100.0_rk * normals(:,bottom), 34) call fem_get_sph_force_summary(total_force, ierr) if (ierr .ne. FEM_SUCCESS) call fail(35) call check_vec(total_force, (/ ZERO, ZERO, ZERO /), 36) call particle_fem_apply_loads(MAXF, MAXN, out_id, out_nnode, node_loads, & ierr) if (ierr .ne. FEM_SUCCESS) call fail(37) call fem_get_sph_force_summary(total_force, ierr) if (ierr .ne. FEM_SUCCESS) call fail(38) call check_vec(total_force, expected_fem, 39) call teardown_model() end subroutine check_collect_then_apply subroutine check_apply_all() type(particle_contact_params) :: params type(pfacet_step_stats) :: stats integer :: nfacet integer :: max_nodes integer :: bottom integer :: ierr integer :: slot integer :: far_slot integer :: slot_count integer :: slots(4) integer :: facet_id(MAXF) integer :: facet_nnode(MAXF) real(rk) :: coords(NDIM,MAXN,MAXF) real(rk) :: normals(NDIM,MAXF) real(rk) :: centroid(NDIM) real(rk) :: total_force(NDIM) real(rk) :: expected_fem(NDIM) call setup_model(nfacet, max_nodes, facet_id, facet_nnode, coords, & normals) call setup_contact_particle(nfacet, facet_nnode, coords, normals, bottom, & centroid, slot, params) call particle_add(22, (/ 5.0_rk, 5.0_rk, 5.0_rk /), & (/ ZERO, ZERO, ZERO /), 0.10_rk, ONE, far_slot, ierr) if (ierr .ne. FEM_SUCCESS) call fail(50) if (far_slot .le. slot) call fail(51) call particle_fem_get_active_slots(4, slots, slot_count, ierr) if (ierr .ne. FEM_SUCCESS) call fail(52) if (slot_count .ne. 2) call fail(53) if (slots(1) .ne. slot .or. slots(2) .ne. far_slot) call fail(54) call fem_clear_sph_forces(ierr) if (ierr .ne. FEM_SUCCESS) call fail(55) call particle_fem_apply_all(params, .true., stats, ierr) if (ierr .ne. FEM_SUCCESS) call fail(56) call check_step_stats(stats, 2, 1, 0.10_rk, 5.0_rk, 100.0_rk, 57) expected_fem = -100.0_rk * normals(:,bottom) call fem_get_sph_force_summary(total_force, ierr) if (ierr .ne. FEM_SUCCESS) call fail(58) call check_vec(total_force, expected_fem, 59) call teardown_model() end subroutine check_apply_all subroutine check_scan_preserves_forces() type(particle_contact_params) :: params type(pfacet_step_stats) :: stats integer :: nfacet integer :: max_nodes integer :: bottom integer :: ierr integer :: slot integer :: slots(1) integer :: facet_id(MAXF) integer :: facet_nnode(MAXF) real(rk) :: coords(NDIM,MAXN,MAXF) real(rk) :: normals(NDIM,MAXF) real(rk) :: centroid(NDIM) real(rk) :: saved_force(NDIM) real(rk) :: particle_force(NDIM) real(rk) :: total_force(NDIM) call setup_model(nfacet, max_nodes, facet_id, facet_nnode, coords, & normals) call setup_contact_particle(nfacet, facet_nnode, coords, normals, bottom, & centroid, slot, params) saved_force = (/ 7.0_rk, -3.0_rk, 2.0_rk /) call particle_set_force(slot, saved_force, ierr) if (ierr .ne. FEM_SUCCESS) call fail(70) slots(1) = slot call fem_clear_sph_forces(ierr) if (ierr .ne. FEM_SUCCESS) call fail(71) call particle_fem_scan_facets(1, slots, params, stats, ierr) if (ierr .ne. FEM_SUCCESS) call fail(72) call check_step_stats(stats, 1, 1, 0.10_rk, 5.0_rk, 100.0_rk, 73) call get_particle_force(slot, particle_force) call check_vec(particle_force, saved_force, 74) call fem_get_sph_force_summary(total_force, ierr) if (ierr .ne. FEM_SUCCESS) call fail(75) call check_vec(total_force, (/ ZERO, ZERO, ZERO /), 76) call particle_fem_scan_all(params, stats, ierr) if (ierr .ne. FEM_SUCCESS) call fail(77) call get_particle_force(slot, particle_force) call check_vec(particle_force, saved_force, 78) call teardown_model() end subroutine check_scan_preserves_forces subroutine check_collect_all_loads() type(particle_contact_params) :: params type(pfacet_step_stats) :: stats integer :: nfacet integer :: max_nodes integer :: bottom integer :: ierr integer :: slot integer :: out_id(MAXF) integer :: out_nnode(MAXF) integer :: facet_id(MAXF) integer :: facet_nnode(MAXF) real(rk) :: coords(NDIM,MAXN,MAXF) real(rk) :: normals(NDIM,MAXF) real(rk) :: node_loads(NDIM,MAXN,MAXF) real(rk) :: centroid(NDIM) real(rk) :: total_load(NDIM) real(rk) :: pnorm real(rk) :: nnorm call setup_model(nfacet, max_nodes, facet_id, facet_nnode, coords, & normals) call setup_contact_particle(nfacet, facet_nnode, coords, normals, bottom, & centroid, slot, params) call particle_fem_collect_all_loads(params, .true., MAXF, MAXN, out_id, & out_nnode, node_loads, stats, ierr) if (ierr .ne. FEM_SUCCESS) call fail(90) call sum_all_loads(MAXF, MAXN, node_loads, total_load) call check_vec(total_load, -100.0_rk * normals(:,bottom), 91) call particle_fem_stats_force_norms(stats, pnorm, nnorm, ierr) if (ierr .ne. FEM_SUCCESS) call fail(92) call check_close(pnorm, 100.0_rk, 93) call check_close(nnorm, 100.0_rk, 94) if (out_id(bottom) .ne. facet_id(bottom)) call fail(95) if (out_nnode(bottom) .ne. facet_nnode(bottom)) call fail(96) call teardown_model() end subroutine check_collect_all_loads subroutine check_error_paths() type(particle_contact_params) :: params type(pfacet_step_stats) :: stats integer :: nfacet integer :: max_nodes integer :: bottom integer :: ierr integer :: slot integer :: slots(1) integer :: one_id(1) integer :: one_nnode(1) integer :: facet_id(MAXF) integer :: facet_nnode(MAXF) real(rk) :: coords(NDIM,MAXN,MAXF) real(rk) :: normals(NDIM,MAXF) real(rk) :: node_loads(NDIM,MAXN,MAXF) real(rk) :: small_loads(NDIM,1,1) real(rk) :: centroid(NDIM) call setup_model(nfacet, max_nodes, facet_id, facet_nnode, coords, & normals) call setup_contact_particle(nfacet, facet_nnode, coords, normals, bottom, & centroid, slot, params) slots(1) = slot call particle_fem_collect_loads(1, slots, params, .true., 1, MAXN, & one_id, one_nnode, node_loads(:,:,1:1), & stats, ierr) if (ierr .eq. FEM_SUCCESS) call fail(110) small_loads = ZERO one_id(1) = facet_id(bottom) one_nnode(1) = facet_nnode(bottom) call particle_fem_apply_loads(1, 1, one_id, one_nnode, small_loads, ierr) if (ierr .eq. FEM_SUCCESS) call fail(111) call particle_contact_init(-ONE, ZERO, ZERO, ZERO, 1000.0_rk, ZERO, & params, ierr) if (ierr .eq. FEM_SUCCESS) call fail(112) call teardown_model() end subroutine check_error_paths subroutine setup_model(nfacet, max_nodes, facet_id, facet_nnode, coords, & normals) integer, intent(out) :: nfacet integer, intent(out) :: max_nodes integer, intent(out) :: facet_id(MAXF) integer, intent(out) :: facet_nnode(MAXF) real(rk), intent(out) :: coords(NDIM,MAXN,MAXF) real(rk), intent(out) :: normals(NDIM,MAXF) integer :: ierr integer :: elem_id(MAXF) integer :: face_id(MAXF) integer :: facet_conn(MAXN,MAXF) real(rk) :: velocities(NDIM,MAXN,MAXF) real(rk) :: area(MAXF) call particle_reset() call fem_initialize(ierr) if (ierr .ne. FEM_SUCCESS) call fail(200) call fem_read_inp('examples/c3d4_one_element.inp', ierr) if (ierr .ne. FEM_SUCCESS) call fail(201) call fem_build_model(ierr) if (ierr .ne. FEM_SUCCESS) call fail(202) call fem_get_boundary_facet_count(nfacet, max_nodes, ierr) if (ierr .ne. FEM_SUCCESS) call fail(203) if (nfacet .ne. 4 .or. max_nodes .ne. 3) call fail(204) call fem_get_boundary_facets(MAXF, MAXN, facet_id, elem_id, face_id, & facet_nnode, facet_conn, coords, velocities, & normals, area, ierr) if (ierr .ne. FEM_SUCCESS) call fail(205) end subroutine setup_model subroutine setup_contact_particle(nfacet, facet_nnode, coords, normals, & bottom, centroid, slot, params) integer, intent(in) :: nfacet integer, intent(in) :: facet_nnode(MAXF) real(rk), intent(in) :: coords(NDIM,MAXN,MAXF) real(rk), intent(in) :: normals(NDIM,MAXF) integer, intent(out) :: bottom real(rk), intent(out) :: centroid(NDIM) integer, intent(out) :: slot type(particle_contact_params), intent(out) :: params integer :: ierr real(rk) :: position(NDIM) bottom = find_down_facet(nfacet, normals) if (bottom .le. 0) call fail(220) call facet_centroid(facet_nnode(bottom), coords(:,:,bottom), centroid) position = centroid + 0.20_rk * normals(:,bottom) call particle_add(11, position, (/ ZERO, ZERO, ZERO /), 0.30_rk, ONE, & slot, ierr) if (ierr .ne. FEM_SUCCESS) call fail(221) call particle_contact_init(1000.0_rk, ZERO, ZERO, ZERO, 1000.0_rk, ZERO, & params, ierr) if (ierr .ne. FEM_SUCCESS) call fail(222) end subroutine setup_contact_particle subroutine teardown_model() integer :: ierr call particle_reset() call fem_finalize(ierr) if (ierr .ne. FEM_SUCCESS) call fail(240) end subroutine teardown_model integer function find_down_facet(nfacet, normals) integer, intent(in) :: nfacet real(rk), intent(in) :: normals(NDIM,MAXF) integer :: facet find_down_facet = 0 do facet = 1, nfacet if (normals(3,facet) .lt. -0.5_rk) then find_down_facet = facet return end if end do end function find_down_facet subroutine facet_centroid(nnode, coords, centroid) integer, intent(in) :: nnode real(rk), intent(in) :: coords(NDIM,MAXN) real(rk), intent(out) :: centroid(NDIM) integer :: node centroid = ZERO do node = 1, nnode centroid = centroid + coords(:,node) end do centroid = centroid / real(nnode, rk) end subroutine facet_centroid subroutine fill_uniform_load(nnode, load_vec, node_loads) integer, intent(in) :: nnode real(rk), intent(in) :: load_vec(NDIM) real(rk), intent(out) :: node_loads(NDIM,MAXN) integer :: node node_loads = ZERO do node = 1, nnode node_loads(:,node) = load_vec end do end subroutine fill_uniform_load subroutine sum_all_loads(nfacet, max_nodes, node_loads, total) integer, intent(in) :: nfacet integer, intent(in) :: max_nodes real(rk), intent(in) :: node_loads(NDIM,max_nodes,nfacet) real(rk), intent(out) :: total(NDIM) integer :: facet integer :: node total = ZERO do facet = 1, nfacet do node = 1, max_nodes total = total + node_loads(:,node,facet) end do end do end subroutine sum_all_loads subroutine get_particle_force(slot, force) integer, intent(in) :: slot real(rk), intent(out) :: force(NDIM) integer :: ierr integer :: ext_id logical :: active real(rk) :: position(NDIM) real(rk) :: velocity(NDIM) real(rk) :: radius real(rk) :: mass call particle_get(slot, ext_id, active, position, velocity, radius, mass, & force, ierr) if (ierr .ne. FEM_SUCCESS) call fail(260) if (.not. active) call fail(261) end subroutine get_particle_force subroutine check_step_stats(stats, expected_particles, expected_contacts, & expected_overlap, expected_energy, & expected_force_norm, code) type(pfacet_step_stats), intent(in) :: stats integer, intent(in) :: expected_particles integer, intent(in) :: expected_contacts real(rk), intent(in) :: expected_overlap real(rk), intent(in) :: expected_energy real(rk), intent(in) :: expected_force_norm integer, intent(in) :: code integer :: ierr integer :: particle_count_out integer :: contact_count real(rk) :: max_overlap real(rk) :: elastic_energy real(rk) :: dissipated_power real(rk) :: force_norm call particle_fem_stats_summary(stats, particle_count_out, contact_count, & max_overlap, elastic_energy, & dissipated_power, force_norm, ierr) if (ierr .ne. FEM_SUCCESS) call fail(code) if (particle_count_out .ne. expected_particles) call fail(code + 1) if (contact_count .ne. expected_contacts) call fail(code + 2) call check_close(max_overlap, expected_overlap, code + 3) call check_close(elastic_energy, expected_energy, code + 4) call check_close(force_norm, expected_force_norm, code + 5) call check_close(dissipated_power, ZERO, code + 6) end subroutine check_step_stats 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))) then call fail(code) end if end subroutine check_close subroutine check_vec(actual, expected, code) real(rk), intent(in) :: actual(NDIM) real(rk), intent(in) :: expected(NDIM) integer, intent(in) :: code if (maxval(abs(actual - expected)) .gt. & TOL * max(ONE, maxval(abs(expected)))) then call fail(code) end if end subroutine check_vec subroutine fail(code) integer, intent(in) :: code write(*,*) 'test_particle_fem_coupling failed:', code stop 1 end subroutine fail end program test_particle_fem_coupling