Files
SPHLite/tests/module/test_solid_correction_matrix.f90
2026-07-03 17:19:47 +08:00

122 lines
4.5 KiB
Fortran

program test_solid_correction_matrix
use sph_precision, only: rk, SPH_NDIM
use sph_error, only: SPH_SUCCESS
use sph_api, only: sph_initialize, sph_finalize, sph_read_inp, sph_build_model
use sph_database, only: npart, solid_correction_det_min, &
solid_correction_status_max
use sph_solid_state, only: solid_correction_matrix, &
solid_deformation_gradient, solid_correction_determinant, &
solid_correction_status, SPH_SOLID_CORRECTION_OK, &
SPH_SOLID_CORRECTION_UNDERCONSTRAINED
implicit none
integer :: ierr
call check_normal_correction_matrix()
call check_degenerate_correction_fallback()
contains
subroutine check_normal_correction_matrix()
integer :: i
call sph_initialize(ierr)
call assert_ok(ierr, 'initialize failed for normal correction matrix')
call sph_read_inp('tests/data/solid_reference_normal_051.inp', ierr)
call assert_ok(ierr, 'read failed for normal correction matrix')
call sph_build_model(ierr)
call assert_ok(ierr, 'build failed for normal correction matrix')
if (solid_correction_status_max /= SPH_SOLID_CORRECTION_OK) then
call fail('normal correction summary status mismatch')
end if
if (solid_correction_det_min <= 0.0_rk) call fail('normal correction determinant minimum missing')
do i = 1, npart
if (solid_correction_status(i) /= SPH_SOLID_CORRECTION_OK) then
call fail('normal correction particle status mismatch')
end if
if (solid_correction_determinant(i) <= 0.0_rk) then
call fail('normal correction particle determinant missing')
end if
call assert_finite_matrix(solid_correction_matrix(:,:,i), &
'normal correction matrix is not finite')
call assert_identity(solid_deformation_gradient(:,:,i), &
'normal deformation gradient is not identity')
end do
call sph_finalize(ierr)
call assert_ok(ierr, 'finalize failed for normal correction matrix')
end subroutine check_normal_correction_matrix
subroutine check_degenerate_correction_fallback()
integer :: i
call sph_initialize(ierr)
call assert_ok(ierr, 'initialize failed for degenerate correction matrix')
call sph_read_inp('tests/data/solid_reference_degenerate_051.inp', ierr)
call assert_ok(ierr, 'read failed for degenerate correction matrix')
call sph_build_model(ierr)
call assert_ok(ierr, 'build failed for degenerate correction matrix')
if (solid_correction_status_max /= SPH_SOLID_CORRECTION_UNDERCONSTRAINED) then
call fail('degenerate correction summary status mismatch')
end if
do i = 1, npart
if (solid_correction_status(i) /= SPH_SOLID_CORRECTION_UNDERCONSTRAINED) then
call fail('degenerate correction particle status mismatch')
end if
if (abs(solid_correction_determinant(i)) > 0.0_rk) then
call fail('degenerate correction determinant mismatch')
end if
call assert_identity(solid_correction_matrix(:,:,i), &
'degenerate correction fallback mismatch')
call assert_identity(solid_deformation_gradient(:,:,i), &
'degenerate deformation gradient mismatch')
end do
call sph_finalize(ierr)
call assert_ok(ierr, 'finalize failed for degenerate correction matrix')
end subroutine check_degenerate_correction_fallback
subroutine assert_identity(matrix, message)
real(rk), intent(in) :: matrix(:,:)
character(len=*), intent(in) :: message
integer :: i
integer :: j
real(rk) :: expected
do i = 1, SPH_NDIM
do j = 1, SPH_NDIM
expected = 0.0_rk
if (i == j) expected = 1.0_rk
if (abs(matrix(i,j) - expected) > 1.0e-12_rk) call fail(message)
end do
end do
end subroutine assert_identity
subroutine assert_finite_matrix(matrix, message)
real(rk), intent(in) :: matrix(:,:)
character(len=*), intent(in) :: message
integer :: i
integer :: j
do i = 1, SPH_NDIM
do j = 1, SPH_NDIM
if (matrix(i,j) /= matrix(i,j)) call fail(message)
if (abs(matrix(i,j)) > huge(matrix(i,j)) * 0.5_rk) call fail(message)
end do
end do
end subroutine assert_finite_matrix
subroutine assert_ok(ierr_value, message)
integer, intent(in) :: ierr_value
character(len=*), intent(in) :: message
if (ierr_value /= SPH_SUCCESS) call fail(message)
end subroutine assert_ok
subroutine fail(message)
character(len=*), intent(in) :: message
write(*, '(A)') trim(message)
stop 1
end subroutine fail
end program test_solid_correction_matrix