122 lines
4.5 KiB
Fortran
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
|