Add CCLite 0.2.6 penalty contact forces
This commit is contained in:
@@ -20,6 +20,7 @@ set(CCL_COMMON_SOURCES
|
||||
src/geometry/ccl_geometry.f90
|
||||
src/search/ccl_broad_phase.f90
|
||||
src/contact/ccl_contact_narrow.f90
|
||||
src/contact/ccl_contact_force.f90
|
||||
src/diagnostics/ccl_diagnostics.f90
|
||||
src/case/ccl_string_utils.f90
|
||||
src/case/ccl_case_types.f90
|
||||
@@ -105,6 +106,11 @@ add_executable(test_contact_narrow
|
||||
)
|
||||
target_link_libraries(test_contact_narrow PRIVATE ccl_common)
|
||||
|
||||
add_executable(test_contact_force
|
||||
tests/unit/test_contact_force.f90
|
||||
)
|
||||
target_link_libraries(test_contact_force PRIVATE ccl_common)
|
||||
|
||||
add_test(NAME smoke_cclite_version COMMAND cclite --version)
|
||||
add_test(NAME smoke_cclite_help COMMAND cclite --help)
|
||||
add_test(NAME smoke_mock_sph_worker_version COMMAND mock_sph_worker --version)
|
||||
@@ -155,6 +161,7 @@ add_test(NAME V020_interface_view_and_load_buffer COMMAND test_interface_view)
|
||||
add_test(NAME V020_geometry_primitives COMMAND test_geometry_primitives)
|
||||
add_test(NAME V020_broad_phase_search COMMAND test_broad_phase)
|
||||
add_test(NAME V020_narrow_phase_contact COMMAND test_contact_narrow)
|
||||
add_test(NAME V020_penalty_contact_force COMMAND test_contact_force)
|
||||
add_test(NAME dry_run_one_step
|
||||
COMMAND cclite dry-run ${CMAKE_SOURCE_DIR}/tests/data/v010_one_step.inp
|
||||
)
|
||||
|
||||
@@ -0,0 +1,163 @@
|
||||
module ccl_contact_force
|
||||
use, intrinsic :: ieee_arithmetic, only: ieee_is_finite
|
||||
use iso_c_binding, only: c_double
|
||||
use ccl_case_types, only: CCL_Surface_Interaction_Config
|
||||
use ccl_contact_narrow, only: CCL_Contact_Record_Type
|
||||
use ccl_errors, only: CCL_ERROR_INPUT_INVALID_VALUE, CCL_SUCCESS
|
||||
use ccl_geometry, only: ccl_vec3_cross, ccl_vec3_dot, ccl_vec3_norm
|
||||
use ccl_interface_view, only: CCL_FEM_Facet_View_Type, CCL_FEM_Load_Accumulator_Type, &
|
||||
CCL_SPH_Force_Accumulator_Type, CCL_SPH_Particle_View_Type, ccl_fem_load_accumulator_add_node, &
|
||||
ccl_sph_force_accumulator_add
|
||||
implicit none
|
||||
|
||||
type :: CCL_Contact_Force_Stats_Type
|
||||
integer :: contact_count = 0
|
||||
integer :: nonfinite_force_count = 0
|
||||
real(c_double) :: max_force_norm = 0.0_c_double
|
||||
real(c_double) :: total_sph_force(3) = 0.0_c_double
|
||||
real(c_double) :: total_fem_force(3) = 0.0_c_double
|
||||
real(c_double) :: total_sph_moment(3) = 0.0_c_double
|
||||
real(c_double) :: total_fem_moment(3) = 0.0_c_double
|
||||
real(c_double) :: force_balance_error = 0.0_c_double
|
||||
real(c_double) :: moment_balance_error = 0.0_c_double
|
||||
end type CCL_Contact_Force_Stats_Type
|
||||
|
||||
contains
|
||||
|
||||
subroutine ccl_contact_force_stats_reset(stats)
|
||||
type(CCL_Contact_Force_Stats_Type), intent(out) :: stats
|
||||
|
||||
stats%contact_count = 0
|
||||
stats%nonfinite_force_count = 0
|
||||
stats%max_force_norm = 0.0_c_double
|
||||
stats%total_sph_force = 0.0_c_double
|
||||
stats%total_fem_force = 0.0_c_double
|
||||
stats%total_sph_moment = 0.0_c_double
|
||||
stats%total_fem_moment = 0.0_c_double
|
||||
stats%force_balance_error = 0.0_c_double
|
||||
stats%moment_balance_error = 0.0_c_double
|
||||
end subroutine ccl_contact_force_stats_reset
|
||||
|
||||
subroutine ccl_contact_force_compute(interaction, particles, particle_count, facets, facet_count, &
|
||||
contacts, contact_count, sph_forces, fem_loads, stats, ierr)
|
||||
type(CCL_Surface_Interaction_Config), intent(in) :: interaction
|
||||
type(CCL_SPH_Particle_View_Type), intent(in) :: particles(:)
|
||||
integer, intent(in) :: particle_count
|
||||
type(CCL_FEM_Facet_View_Type), intent(in) :: facets(:)
|
||||
integer, intent(in) :: facet_count
|
||||
type(CCL_Contact_Record_Type), intent(in) :: contacts(:)
|
||||
integer, intent(in) :: contact_count
|
||||
type(CCL_SPH_Force_Accumulator_Type), intent(inout) :: sph_forces
|
||||
type(CCL_FEM_Load_Accumulator_Type), intent(inout) :: fem_loads
|
||||
type(CCL_Contact_Force_Stats_Type), intent(inout) :: stats
|
||||
integer, intent(out) :: ierr
|
||||
integer :: i
|
||||
|
||||
ierr = CCL_SUCCESS
|
||||
if (interaction%kn <= 0.0_c_double .or. .not. ieee_is_finite(interaction%kn)) then
|
||||
ierr = CCL_ERROR_INPUT_INVALID_VALUE
|
||||
return
|
||||
end if
|
||||
if (interaction%cn < 0.0_c_double .or. .not. ieee_is_finite(interaction%cn)) then
|
||||
ierr = CCL_ERROR_INPUT_INVALID_VALUE
|
||||
return
|
||||
end if
|
||||
|
||||
do i = 1, contact_count
|
||||
if (contacts(i)%particle_index < 1 .or. contacts(i)%particle_index > particle_count .or. &
|
||||
contacts(i)%facet_index < 1 .or. contacts(i)%facet_index > facet_count) then
|
||||
ierr = CCL_ERROR_INPUT_INVALID_VALUE
|
||||
return
|
||||
end if
|
||||
call compute_one_contact(interaction, particles(contacts(i)%particle_index), &
|
||||
facets(contacts(i)%facet_index), contacts(i), sph_forces, fem_loads, stats, ierr)
|
||||
if (ierr /= CCL_SUCCESS) return
|
||||
end do
|
||||
stats%contact_count = contact_count
|
||||
stats%force_balance_error = ccl_vec3_norm(stats%total_sph_force + stats%total_fem_force)
|
||||
stats%moment_balance_error = ccl_vec3_norm(stats%total_sph_moment + stats%total_fem_moment)
|
||||
end subroutine ccl_contact_force_compute
|
||||
|
||||
subroutine compute_one_contact(interaction, particle, facet, contact, sph_forces, fem_loads, stats, ierr)
|
||||
type(CCL_Surface_Interaction_Config), intent(in) :: interaction
|
||||
type(CCL_SPH_Particle_View_Type), intent(in) :: particle
|
||||
type(CCL_FEM_Facet_View_Type), intent(in) :: facet
|
||||
type(CCL_Contact_Record_Type), intent(in) :: contact
|
||||
type(CCL_SPH_Force_Accumulator_Type), intent(inout) :: sph_forces
|
||||
type(CCL_FEM_Load_Accumulator_Type), intent(inout) :: fem_loads
|
||||
type(CCL_Contact_Force_Stats_Type), intent(inout) :: stats
|
||||
integer, intent(out) :: ierr
|
||||
real(c_double) :: fem_velocity(3)
|
||||
real(c_double) :: relative_velocity(3)
|
||||
real(c_double) :: normal_velocity
|
||||
real(c_double) :: force_magnitude
|
||||
real(c_double) :: sph_force(3)
|
||||
real(c_double) :: fem_force(3)
|
||||
real(c_double) :: moment(3)
|
||||
integer :: node_id
|
||||
|
||||
ierr = CCL_SUCCESS
|
||||
if (contact%penetration <= 0.0_c_double) return
|
||||
fem_velocity = interpolate_fem_velocity(facet, contact)
|
||||
relative_velocity = particle%v - fem_velocity
|
||||
normal_velocity = ccl_vec3_dot(relative_velocity, contact%normal)
|
||||
force_magnitude = interaction%kn * contact%penetration + interaction%cn * max(0.0_c_double, -normal_velocity)
|
||||
sph_force = force_magnitude * contact%normal
|
||||
if (.not. finite_vector3(sph_force)) then
|
||||
stats%nonfinite_force_count = stats%nonfinite_force_count + 1
|
||||
ierr = CCL_ERROR_INPUT_INVALID_VALUE
|
||||
return
|
||||
end if
|
||||
|
||||
call ccl_sph_force_accumulator_add(sph_forces, particle%external_id, particle%internal_index, &
|
||||
sph_force, ierr)
|
||||
if (ierr /= CCL_SUCCESS) return
|
||||
stats%total_sph_force = stats%total_sph_force + sph_force
|
||||
call ccl_vec3_cross(particle%x, sph_force, moment)
|
||||
stats%total_sph_moment = stats%total_sph_moment + moment
|
||||
stats%max_force_norm = max(stats%max_force_norm, ccl_vec3_norm(sph_force))
|
||||
|
||||
do node_id = 1, int(contact%node_count)
|
||||
fem_force = -contact%shape_weights(node_id) * sph_force
|
||||
if (.not. finite_vector3(fem_force)) then
|
||||
stats%nonfinite_force_count = stats%nonfinite_force_count + 1
|
||||
ierr = CCL_ERROR_INPUT_INVALID_VALUE
|
||||
return
|
||||
end if
|
||||
call ccl_fem_load_accumulator_add_node(fem_loads, facet%node_ids(node_id), fem_force, ierr)
|
||||
if (ierr /= CCL_SUCCESS) return
|
||||
stats%total_fem_force = stats%total_fem_force + fem_force
|
||||
call ccl_vec3_cross(facet%x(:, node_id), fem_force, moment)
|
||||
stats%total_fem_moment = stats%total_fem_moment + moment
|
||||
end do
|
||||
end subroutine compute_one_contact
|
||||
|
||||
real(c_double) function ccl_contact_normal_velocity(particle, facet, contact) result(normal_velocity)
|
||||
type(CCL_SPH_Particle_View_Type), intent(in) :: particle
|
||||
type(CCL_FEM_Facet_View_Type), intent(in) :: facet
|
||||
type(CCL_Contact_Record_Type), intent(in) :: contact
|
||||
real(c_double) :: fem_velocity(3)
|
||||
|
||||
fem_velocity = interpolate_fem_velocity(facet, contact)
|
||||
normal_velocity = ccl_vec3_dot(particle%v - fem_velocity, contact%normal)
|
||||
end function ccl_contact_normal_velocity
|
||||
|
||||
function interpolate_fem_velocity(facet, contact) result(velocity)
|
||||
type(CCL_FEM_Facet_View_Type), intent(in) :: facet
|
||||
type(CCL_Contact_Record_Type), intent(in) :: contact
|
||||
real(c_double) :: velocity(3)
|
||||
integer :: node_id
|
||||
|
||||
velocity = 0.0_c_double
|
||||
do node_id = 1, int(contact%node_count)
|
||||
velocity = velocity + contact%shape_weights(node_id) * facet%v(:, node_id)
|
||||
end do
|
||||
end function interpolate_fem_velocity
|
||||
|
||||
logical function finite_vector3(value) result(is_finite)
|
||||
real(c_double), intent(in) :: value(3)
|
||||
|
||||
is_finite = ieee_is_finite(value(1)) .and. ieee_is_finite(value(2)) .and. ieee_is_finite(value(3))
|
||||
end function finite_vector3
|
||||
|
||||
end module ccl_contact_force
|
||||
@@ -0,0 +1,131 @@
|
||||
program test_contact_force
|
||||
use iso_c_binding, only: c_double, c_int32_t, c_int64_t
|
||||
use ccl_case_types, only: CCL_Surface_Interaction_Config
|
||||
use ccl_contact_force, only: CCL_Contact_Force_Stats_Type, ccl_contact_force_compute, &
|
||||
ccl_contact_force_stats_reset, ccl_contact_normal_velocity
|
||||
use ccl_contact_narrow, only: CCL_Contact_Record_Type
|
||||
use ccl_errors, only: CCL_SUCCESS
|
||||
use ccl_interface_view, only: CCL_FEM_Facet_View_Type, CCL_FEM_Load_Accumulator_Type, &
|
||||
CCL_SPH_Force_Accumulator_Type, CCL_SPH_Particle_View_Type, ccl_fem_load_accumulator_init, &
|
||||
ccl_sph_force_accumulator_init
|
||||
implicit none
|
||||
|
||||
integer :: ierr
|
||||
type(CCL_Surface_Interaction_Config) :: interaction
|
||||
type(CCL_SPH_Particle_View_Type) :: particles(1)
|
||||
type(CCL_FEM_Facet_View_Type) :: facets(1)
|
||||
type(CCL_Contact_Record_Type) :: contacts(1)
|
||||
type(CCL_SPH_Force_Accumulator_Type) :: sph_forces
|
||||
type(CCL_FEM_Load_Accumulator_Type) :: fem_loads
|
||||
type(CCL_Contact_Force_Stats_Type) :: stats
|
||||
|
||||
call make_interaction(interaction)
|
||||
call make_particle(particles(1))
|
||||
call make_facet(facets(1))
|
||||
call make_contact(contacts(1))
|
||||
call ccl_sph_force_accumulator_init(sph_forces, 2)
|
||||
call ccl_fem_load_accumulator_init(fem_loads, 8)
|
||||
call ccl_contact_force_stats_reset(stats)
|
||||
|
||||
call require_real_close(ccl_contact_normal_velocity(particles(1), facets(1), contacts(1)), &
|
||||
-1.0_c_double, "normal velocity")
|
||||
call ccl_contact_force_compute(interaction, particles, 1, facets, 1, contacts, 1, sph_forces, &
|
||||
fem_loads, stats, ierr)
|
||||
call require_equal(ierr, CCL_SUCCESS, "penalty force compute")
|
||||
call require_equal(sph_forces%count, 1, "SPH force count")
|
||||
call require_equal(fem_loads%count, 4, "FEM nodal load count")
|
||||
call require_real_close(sph_forces%records(1)%force(3), 20.0_c_double, "SPH penalty damping force")
|
||||
call require_real_close(stats%total_sph_force(3), 20.0_c_double, "total SPH force")
|
||||
call require_real_close(stats%total_fem_force(3), -20.0_c_double, "total FEM force")
|
||||
call require_real_close(stats%force_balance_error, 0.0_c_double, "force balance")
|
||||
call require_real_close(stats%moment_balance_error, 0.0_c_double, "moment balance")
|
||||
call require_equal(stats%nonfinite_force_count, 0, "nonfinite force count")
|
||||
|
||||
contains
|
||||
|
||||
subroutine make_interaction(value)
|
||||
type(CCL_Surface_Interaction_Config), intent(out) :: value
|
||||
|
||||
value = CCL_Surface_Interaction_Config()
|
||||
value%name = "PENALTY_1"
|
||||
value%normal_model = "PENALTY"
|
||||
value%kn = 100.0_c_double
|
||||
value%cn = 10.0_c_double
|
||||
value%has_kn = .true.
|
||||
value%has_cn = .true.
|
||||
end subroutine make_interaction
|
||||
|
||||
subroutine make_particle(particle)
|
||||
type(CCL_SPH_Particle_View_Type), intent(out) :: particle
|
||||
|
||||
particle = CCL_SPH_Particle_View_Type()
|
||||
particle%external_id = 101_c_int64_t
|
||||
particle%internal_index = 1_c_int32_t
|
||||
particle%status = 1_c_int32_t
|
||||
particle%valid_flags = 1_c_int32_t
|
||||
particle%contact_radius = 0.2_c_double
|
||||
particle%mass = 1.0_c_double
|
||||
particle%x = [0.25_c_double, 0.25_c_double, 0.10_c_double]
|
||||
particle%v = [0.0_c_double, 0.0_c_double, -1.0_c_double]
|
||||
end subroutine make_particle
|
||||
|
||||
subroutine make_facet(facet)
|
||||
type(CCL_FEM_Facet_View_Type), intent(out) :: facet
|
||||
|
||||
facet = CCL_FEM_Facet_View_Type()
|
||||
facet%facet_id = 201_c_int64_t
|
||||
facet%node_count = 4_c_int32_t
|
||||
facet%node_ids(1:4) = [201_c_int64_t, 202_c_int64_t, 203_c_int64_t, 204_c_int64_t]
|
||||
facet%area = 1.0_c_double
|
||||
facet%thickness = 0.0_c_double
|
||||
facet%normal = [0.0_c_double, 0.0_c_double, 1.0_c_double]
|
||||
facet%x(:, 1) = [0.0_c_double, 0.0_c_double, 0.0_c_double]
|
||||
facet%x(:, 2) = [1.0_c_double, 0.0_c_double, 0.0_c_double]
|
||||
facet%x(:, 3) = [1.0_c_double, 1.0_c_double, 0.0_c_double]
|
||||
facet%x(:, 4) = [0.0_c_double, 1.0_c_double, 0.0_c_double]
|
||||
facet%v = 0.0_c_double
|
||||
facet%valid_flags = 1_c_int32_t
|
||||
end subroutine make_facet
|
||||
|
||||
subroutine make_contact(contact)
|
||||
type(CCL_Contact_Record_Type), intent(out) :: contact
|
||||
|
||||
contact = CCL_Contact_Record_Type()
|
||||
contact%step_id = 1_c_int32_t
|
||||
contact%pair_id = 1_c_int32_t
|
||||
contact%particle_index = 1
|
||||
contact%facet_index = 1
|
||||
contact%sph_external_id = 101_c_int64_t
|
||||
contact%facet_id = 201_c_int64_t
|
||||
contact%node_count = 4_c_int32_t
|
||||
contact%normal = [0.0_c_double, 0.0_c_double, 1.0_c_double]
|
||||
contact%gap = 0.1_c_double
|
||||
contact%contact_distance = 0.2_c_double
|
||||
contact%penetration = 0.1_c_double
|
||||
contact%closest_point = [0.25_c_double, 0.25_c_double, 0.0_c_double]
|
||||
contact%shape_weights(1:4) = [0.5625_c_double, 0.1875_c_double, 0.0625_c_double, 0.1875_c_double]
|
||||
end subroutine make_contact
|
||||
|
||||
subroutine require_equal(actual, expected, message)
|
||||
integer, intent(in) :: actual
|
||||
integer, intent(in) :: expected
|
||||
character(len=*), intent(in) :: message
|
||||
|
||||
if (actual /= expected) then
|
||||
print '(a,": expected ",i0," got ",i0)', trim(message), expected, actual
|
||||
stop 1
|
||||
end if
|
||||
end subroutine require_equal
|
||||
|
||||
subroutine require_real_close(actual, expected, message)
|
||||
real(c_double), intent(in) :: actual
|
||||
real(c_double), intent(in) :: expected
|
||||
character(len=*), intent(in) :: message
|
||||
|
||||
if (abs(actual - expected) > 1.0e-10_c_double) then
|
||||
print '(a,": expected ",es12.4," got ",es12.4)', trim(message), expected, actual
|
||||
stop 1
|
||||
end if
|
||||
end subroutine require_real_close
|
||||
|
||||
end program test_contact_force
|
||||
@@ -264,40 +264,40 @@
|
||||
|
||||
目标:实现法向 penalty damping 力,并写回 SPH force 与 FEM nodal load。
|
||||
|
||||
- [ ] T0206-01 从 interaction 中读取 `KN` 和 `CN`。
|
||||
- [x] T0206-01 从 interaction 中读取 `KN` 和 `CN`。
|
||||
完成判据:每个 contact pair 使用其引用 interaction 的刚度和阻尼。
|
||||
|
||||
- [ ] T0206-02 计算 FEM 最近点速度。
|
||||
- [x] T0206-02 计算 FEM 最近点速度。
|
||||
完成判据:使用 contact shape weight 从 FEM 节点速度插值得到最近点速度。
|
||||
|
||||
- [ ] T0206-03 计算法向相对速度。
|
||||
- [x] T0206-03 计算法向相对速度。
|
||||
完成判据:`v_n` 的符号与阻尼公式约定一致,并有单元测试。
|
||||
|
||||
- [ ] T0206-04 实现法向 penalty 力。
|
||||
- [x] T0206-04 实现法向 penalty 力。
|
||||
完成判据:`CN=0` 时力大小等于 `KN * penetration`。
|
||||
|
||||
- [ ] T0206-05 实现基础法向阻尼力。
|
||||
- [x] T0206-05 实现基础法向阻尼力。
|
||||
完成判据:闭合速度产生非负阻尼项,分离速度不增加吸引力。
|
||||
|
||||
- [ ] T0206-06 合成 SPH 粒子接触力。
|
||||
- [x] T0206-06 合成 SPH 粒子接触力。
|
||||
完成判据:同一粒子多接触力累加后写入 force accumulator。
|
||||
|
||||
- [ ] T0206-07 分配 FEM 节点反力。
|
||||
- [x] T0206-07 分配 FEM 节点反力。
|
||||
完成判据:节点力合力等于 `-SPH_contact_force`,权重来自 shape weight。
|
||||
|
||||
- [ ] T0206-08 增加非有限力保护。
|
||||
- [x] T0206-08 增加非有限力保护。
|
||||
完成判据:非有限 penetration、速度或力会终止当前 step 并输出错误。
|
||||
|
||||
- [ ] T0206-09 写回 SPH force block。
|
||||
- [x] T0206-09 写回 SPH force block。
|
||||
完成判据:`CCL_TO_SPH_FORCE` 中包含非空力记录,并可被 mock worker 消费。
|
||||
|
||||
- [ ] T0206-10 写回 FEM load block。
|
||||
- [x] T0206-10 写回 FEM load block。
|
||||
完成判据:`CCL_TO_FEM_LOAD` 中包含非空节点力记录,并可被 mock worker 消费。
|
||||
|
||||
- [ ] T0206-11 输出力和力矩平衡诊断。
|
||||
- [x] T0206-11 输出力和力矩平衡诊断。
|
||||
完成判据:每步记录 SPH 总力、FEM 总力、合力误差和力矩误差。
|
||||
|
||||
- [ ] T0206-12 增加 penalty force 单元测试。
|
||||
- [x] T0206-12 增加 penalty force 单元测试。
|
||||
完成判据:覆盖零穿透、单点穿透、阻尼、节点分配和非有限保护。
|
||||
|
||||
# 9. 0.2.7 Controller 接触流程与诊断
|
||||
|
||||
Reference in New Issue
Block a user