Add Solid reference correction diagnostics
This commit is contained in:
@@ -0,0 +1,121 @@
|
||||
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
|
||||
Reference in New Issue
Block a user