Add water input validation and SPH kernels
This commit is contained in:
@@ -273,6 +273,8 @@ contains
|
||||
call sph_input_parse_particle_control(line, ierr)
|
||||
else if (index(upper_line, 'BODY FORCE') > 0) then
|
||||
call sph_input_parse_body_force(line, ierr)
|
||||
else
|
||||
input_warning_count = input_warning_count + 1
|
||||
end if
|
||||
else if (key_id == SPH_KEY_ELEMENT) then
|
||||
call sph_input_get_option(line, 'TYPE', active_element_type)
|
||||
|
||||
@@ -1,5 +1,14 @@
|
||||
module sph_particle
|
||||
use sph_precision, only: rk, SPH_NDIM
|
||||
use sph_error, only: SPH_SUCCESS, SPH_ERROR_ARGUMENT, sph_error_set
|
||||
implicit none
|
||||
|
||||
real(rk), parameter :: SPH_PI = 3.1415926535897932384626433832795_rk
|
||||
integer, parameter :: SPH_KERNEL_WENDLAND_C2 = 1
|
||||
integer, parameter :: SPH_KERNEL_WENDLAND_C4 = 2
|
||||
integer, parameter :: SPH_KERNEL_CUBIC_SPLINE = 3
|
||||
integer, parameter :: SPH_KERNEL_DEFAULT = SPH_KERNEL_WENDLAND_C2
|
||||
|
||||
logical :: particle_module_initialized = .false.
|
||||
|
||||
contains
|
||||
@@ -12,4 +21,115 @@ contains
|
||||
particle_module_initialized = .false.
|
||||
end subroutine sph_particle_reset
|
||||
|
||||
subroutine sph_kernel_support_radius(kernel_type, h_value, support, ierr)
|
||||
integer, intent(in) :: kernel_type
|
||||
real(rk), intent(in) :: h_value
|
||||
real(rk), intent(out) :: support
|
||||
integer, intent(out) :: ierr
|
||||
|
||||
ierr = SPH_SUCCESS
|
||||
support = 0.0_rk
|
||||
if (h_value <= 0.0_rk) then
|
||||
call sph_error_set(SPH_ERROR_ARGUMENT, 'kernel smoothing length must be positive')
|
||||
ierr = SPH_ERROR_ARGUMENT
|
||||
return
|
||||
end if
|
||||
if (.not. sph_kernel_is_supported(kernel_type)) then
|
||||
call sph_error_set(SPH_ERROR_ARGUMENT, 'unknown SPH kernel type')
|
||||
ierr = SPH_ERROR_ARGUMENT
|
||||
return
|
||||
end if
|
||||
support = 2.0_rk * h_value
|
||||
end subroutine sph_kernel_support_radius
|
||||
|
||||
subroutine sph_kernel_value(kernel_type, r_value, h_value, w_value, ierr)
|
||||
integer, intent(in) :: kernel_type
|
||||
real(rk), intent(in) :: r_value
|
||||
real(rk), intent(in) :: h_value
|
||||
real(rk), intent(out) :: w_value
|
||||
integer, intent(out) :: ierr
|
||||
real(rk) :: q
|
||||
real(rk) :: s
|
||||
|
||||
ierr = SPH_SUCCESS
|
||||
w_value = 0.0_rk
|
||||
if (h_value <= 0.0_rk) then
|
||||
call sph_error_set(SPH_ERROR_ARGUMENT, 'kernel smoothing length must be positive')
|
||||
ierr = SPH_ERROR_ARGUMENT
|
||||
return
|
||||
end if
|
||||
if (.not. sph_kernel_is_supported(kernel_type)) then
|
||||
call sph_error_set(SPH_ERROR_ARGUMENT, 'unknown SPH kernel type')
|
||||
ierr = SPH_ERROR_ARGUMENT
|
||||
return
|
||||
end if
|
||||
q = abs(r_value) / h_value
|
||||
if (q >= 2.0_rk) return
|
||||
if (kernel_type == SPH_KERNEL_WENDLAND_C2) then
|
||||
s = 1.0_rk - 0.5_rk * q
|
||||
w_value = 21.0_rk / (16.0_rk * SPH_PI * h_value**3) * s**4 * (2.0_rk * q + 1.0_rk)
|
||||
else if (kernel_type == SPH_KERNEL_WENDLAND_C4) then
|
||||
s = 1.0_rk - 0.5_rk * q
|
||||
w_value = 495.0_rk / (256.0_rk * SPH_PI * h_value**3) * s**6 * &
|
||||
(35.0_rk * q * q / 12.0_rk + 3.0_rk * q + 1.0_rk)
|
||||
else
|
||||
if (q < 1.0_rk) then
|
||||
w_value = (1.0_rk - 1.5_rk * q * q + 0.75_rk * q**3) / (SPH_PI * h_value**3)
|
||||
else
|
||||
w_value = 0.25_rk * (2.0_rk - q)**3 / (SPH_PI * h_value**3)
|
||||
end if
|
||||
end if
|
||||
end subroutine sph_kernel_value
|
||||
|
||||
subroutine sph_kernel_gradient(kernel_type, rij, h_value, grad_w, ierr)
|
||||
integer, intent(in) :: kernel_type
|
||||
real(rk), intent(in) :: rij(SPH_NDIM)
|
||||
real(rk), intent(in) :: h_value
|
||||
real(rk), intent(out) :: grad_w(SPH_NDIM)
|
||||
integer, intent(out) :: ierr
|
||||
real(rk) :: r_value
|
||||
real(rk) :: q
|
||||
real(rk) :: s
|
||||
real(rk) :: dwdq
|
||||
|
||||
ierr = SPH_SUCCESS
|
||||
grad_w = 0.0_rk
|
||||
if (h_value <= 0.0_rk) then
|
||||
call sph_error_set(SPH_ERROR_ARGUMENT, 'kernel smoothing length must be positive')
|
||||
ierr = SPH_ERROR_ARGUMENT
|
||||
return
|
||||
end if
|
||||
if (.not. sph_kernel_is_supported(kernel_type)) then
|
||||
call sph_error_set(SPH_ERROR_ARGUMENT, 'unknown SPH kernel type')
|
||||
ierr = SPH_ERROR_ARGUMENT
|
||||
return
|
||||
end if
|
||||
r_value = sqrt(sum(rij * rij))
|
||||
if (r_value <= 0.0_rk) return
|
||||
q = r_value / h_value
|
||||
if (q >= 2.0_rk) return
|
||||
if (kernel_type == SPH_KERNEL_WENDLAND_C2) then
|
||||
s = 1.0_rk - 0.5_rk * q
|
||||
dwdq = 21.0_rk / (16.0_rk * SPH_PI * h_value**3) * (-5.0_rk * q * s**3)
|
||||
else if (kernel_type == SPH_KERNEL_WENDLAND_C4) then
|
||||
s = 1.0_rk - 0.5_rk * q
|
||||
dwdq = 495.0_rk / (256.0_rk * SPH_PI * h_value**3) * s**5 * &
|
||||
(-3.0_rk * (35.0_rk * q * q / 12.0_rk + 3.0_rk * q + 1.0_rk) + &
|
||||
s * (35.0_rk * q / 6.0_rk + 3.0_rk))
|
||||
else if (q < 1.0_rk) then
|
||||
dwdq = (-3.0_rk * q + 2.25_rk * q * q) / (SPH_PI * h_value**3)
|
||||
else
|
||||
dwdq = -0.75_rk * (2.0_rk - q)**2 / (SPH_PI * h_value**3)
|
||||
end if
|
||||
grad_w = (dwdq / h_value) * rij / r_value
|
||||
end subroutine sph_kernel_gradient
|
||||
|
||||
logical function sph_kernel_is_supported(kernel_type)
|
||||
integer, intent(in) :: kernel_type
|
||||
|
||||
sph_kernel_is_supported = kernel_type == SPH_KERNEL_WENDLAND_C2 .or. &
|
||||
kernel_type == SPH_KERNEL_WENDLAND_C4 .or. &
|
||||
kernel_type == SPH_KERNEL_CUBIC_SPLINE
|
||||
end function sph_kernel_is_supported
|
||||
|
||||
end module sph_particle
|
||||
|
||||
Reference in New Issue
Block a user