500 lines
17 KiB
Fortran
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
|