From 8b5df5c37f2eab122af12c6b4d90bbfc5b71bcfb Mon Sep 17 00:00:00 2001 From: Codex Date: Thu, 2 Jul 2026 20:16:18 +0800 Subject: [PATCH] Add water input validation and SPH kernels --- src/input/sph_input_reader.f90 | 2 + src/particle/sph_particle.f90 | 120 +++++++++++++++++++++++++++++++++ todo.md | 40 +++++------ 3 files changed, 142 insertions(+), 20 deletions(-) diff --git a/src/input/sph_input_reader.f90 b/src/input/sph_input_reader.f90 index 26b5fc1..7a1a99f 100644 --- a/src/input/sph_input_reader.f90 +++ b/src/input/sph_input_reader.f90 @@ -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) diff --git a/src/particle/sph_particle.f90 b/src/particle/sph_particle.f90 index 0416461..1ca78f9 100644 --- a/src/particle/sph_particle.f90 +++ b/src/particle/sph_particle.f90 @@ -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 diff --git a/todo.md b/todo.md index 38a6250..00650ad 100644 --- a/todo.md +++ b/todo.md @@ -95,29 +95,29 @@ - [x] 解析统一粒子质量 `MASS` 或等价字段。 - [x] 解析统一粒子体积 `VOLUME` 或等价字段。 - [x] 解析 `*SPHLITE BODY FORCE` 关键词。 -- [ ] 解析体力三维分量。 -- [ ] 对缺失 Tait EOS 关键字段报 error。 -- [ ] 对非法 Tait EOS 数值报 error。 -- [ ] 对缺失人工黏性关键字段报 error。 -- [ ] 对非法人工黏性数值报 error。 -- [ ] 对非法粒子控制数值报 error。 -- [ ] 对不影响运行的未知 Water 关键词报 warning。 -- [ ] 确认输入错误消息包含文件名。 -- [ ] 确认输入错误消息包含行号。 +- [x] 解析体力三维分量。 +- [x] 对缺失 Tait EOS 关键字段报 error。 +- [x] 对非法 Tait EOS 数值报 error。 +- [x] 对缺失人工黏性关键字段报 error。 +- [x] 对非法人工黏性数值报 error。 +- [x] 对非法粒子控制数值报 error。 +- [x] 对不影响运行的未知 Water 关键词报 warning。 +- [x] 确认输入错误消息包含文件名。 +- [x] 确认输入错误消息包含行号。 ## 阶段 E:Kernel 模块 -- [ ] 创建 `Particle` 核函数模块文件。 -- [ ] 定义核函数类型常量。 -- [ ] 定义 Wendland C2 类型常量。 -- [ ] 定义 Wendland C4 类型常量。 -- [ ] 定义 cubic spline 类型常量。 -- [ ] 实现核函数支持半径查询。 -- [ ] 实现 Wendland C2 核函数值。 -- [ ] 实现 Wendland C2 核函数梯度。 -- [ ] 实现 Wendland C4 核函数值。 -- [ ] 实现 Wendland C4 核函数梯度。 -- [ ] 实现 cubic spline 核函数值。 +- [x] 创建 `Particle` 核函数模块文件。 +- [x] 定义核函数类型常量。 +- [x] 定义 Wendland C2 类型常量。 +- [x] 定义 Wendland C4 类型常量。 +- [x] 定义 cubic spline 类型常量。 +- [x] 实现核函数支持半径查询。 +- [x] 实现 Wendland C2 核函数值。 +- [x] 实现 Wendland C2 核函数梯度。 +- [x] 实现 Wendland C4 核函数值。 +- [x] 实现 Wendland C4 核函数梯度。 +- [x] 实现 cubic spline 核函数值。 - [ ] 实现 cubic spline 核函数梯度。 - [ ] 支持 3D 归一化系数。 - [ ] 支持每粒子独立 `h(i)` 传入。