Files
FemLite/tests/module/test_particle_fem_coupling.f90
T
2026-06-26 00:48:57 +08:00

500 lines
17 KiB
Fortran

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