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