program test_particle_step use fem_precision use fem_error use fem_particle_state use fem_particle_contact use fem_particle_step use fem_particle_audit use fem_nonlinear_lifecycle, only: nl_lifecycle_get_audit, & nl_lifecycle_reset implicit none real(rk), parameter :: TOL = 1.0e-10_rk call check_ctrl_wall() call check_pair_step() call check_wall_step() call check_bounds_and_dt() call check_audit_paths() call check_error_paths() contains subroutine check_ctrl_wall() type(particle_step_ctrl) :: ctrl type(particle_wall_def) :: wall integer :: ierr call pstep_ctrl_init(0.01_rk, 0.02_rk, (/ ZERO, ZERO, -9.8_rk /), & 0.05_rk, ctrl, ierr) if (ierr .ne. FEM_SUCCESS) call fail(10) call check_close(ctrl%dt, 0.01_rk, 11) call check_close(ctrl%damping, 0.02_rk, 12) call check_vec(ctrl%gravity, (/ ZERO, ZERO, -9.8_rk /), 13) if (.not. ctrl%clear_forces) call fail(14) call pstep_wall_init((/ ZERO, ZERO, ZERO /), & (/ ZERO, ZERO, 2.0_rk /), wall, ierr) if (ierr .ne. FEM_SUCCESS) call fail(15) if (.not. wall%active) call fail(16) call check_vec(wall%normal, (/ ZERO, ZERO, ONE /), 17) call pstep_validate_walls((/ wall /), 1, ierr) if (ierr .ne. FEM_SUCCESS) call fail(18) ctrl%dt = ZERO call pstep_ctrl_validate(ctrl, ierr) if (ierr .eq. FEM_SUCCESS) call fail(19) end subroutine check_ctrl_wall subroutine check_pair_step() type(particle_contact_params) :: params type(particle_step_ctrl) :: ctrl type(particle_step_diag) :: diag type(particle_wall_def) :: walls(1) integer :: s1 integer :: s2 integer :: ierr integer :: ext_id integer :: contacts logical :: active real(rk) :: position(3) real(rk) :: velocity(3) real(rk) :: radius real(rk) :: mass real(rk) :: force(3) real(rk) :: max_overlap real(rk) :: total_energy real(rk) :: total_power call particle_reset() call particle_add(1, (/ ZERO, ZERO, ZERO /), (/ ZERO, ZERO, ZERO /), & 0.50_rk, ONE, s1, ierr) if (ierr .ne. FEM_SUCCESS) call fail(40) call particle_add(2, (/ 0.80_rk, ZERO, ZERO /), & (/ ZERO, ZERO, ZERO /), 0.50_rk, ONE, s2, ierr) if (ierr .ne. FEM_SUCCESS) call fail(41) call particle_contact_init(100.0_rk, ZERO, ZERO, ZERO, 100.0_rk, ZERO, & params, ierr) if (ierr .ne. FEM_SUCCESS) call fail(42) call pstep_ctrl_init(0.10_rk, ZERO, (/ ZERO, ZERO, ZERO /), ZERO, & ctrl, ierr) if (ierr .ne. FEM_SUCCESS) call fail(43) walls(1)%active = .false. call pstep_advance(ctrl, params, walls, 1, diag, ierr) if (ierr .ne. FEM_SUCCESS) call fail(44) if (diag%active_count .ne. 2) call fail(45) if (diag%candidate_count .ne. 1) call fail(46) if (diag%pair_count .ne. 1) call fail(47) if (diag%wall_count .ne. 0) call fail(48) call check_close(diag%max_overlap, 0.20_rk, 49) call check_close(diag%elastic_energy, 2.0_rk, 50) call check_close(diag%kinetic_before, ZERO, 51) call check_close(diag%kinetic_after, 4.0_rk, 52) call check_close(diag%max_force, 20.0_rk, 53) call check_close(diag%force_norm_sum, 40.0_rk, 54) call particle_get(s1, ext_id, active, position, velocity, radius, mass, & force, ierr) if (ierr .ne. FEM_SUCCESS) call fail(55) call check_vec(force, (/ -20.0_rk, ZERO, ZERO /), 56) call check_vec(velocity, (/ -2.0_rk, ZERO, ZERO /), 57) call check_vec(position, (/ -0.20_rk, ZERO, ZERO /), 58) call particle_get(s2, ext_id, active, position, velocity, radius, mass, & force, ierr) if (ierr .ne. FEM_SUCCESS) call fail(59) call check_vec(force, (/ 20.0_rk, ZERO, ZERO /), 60) call check_vec(velocity, (/ 2.0_rk, ZERO, ZERO /), 61) call check_vec(position, (/ ONE, ZERO, ZERO /), 62) call pstep_diag_summary(diag, contacts, max_overlap, total_energy, & total_power, ierr) if (ierr .ne. FEM_SUCCESS) call fail(63) if (contacts .ne. 1) call fail(64) call check_close(max_overlap, 0.20_rk, 65) call check_close(total_energy, 6.0_rk, 66) call check_close(total_power, ZERO, 67) end subroutine check_pair_step subroutine check_wall_step() type(particle_contact_params) :: params type(particle_step_ctrl) :: ctrl type(particle_step_diag) :: diag type(particle_wall_def) :: wall(1) type(particle_audit_state) :: audit integer :: slot integer :: ierr integer :: ext_id logical :: active real(rk) :: position(3) real(rk) :: velocity(3) real(rk) :: radius real(rk) :: mass real(rk) :: force(3) call particle_reset() call particle_add(10, (/ ZERO, ZERO, 0.40_rk /), & (/ ZERO, ZERO, -0.50_rk /), 0.50_rk, ONE, slot, ierr) if (ierr .ne. FEM_SUCCESS) call fail(80) call particle_contact_init(1000.0_rk, ZERO, ZERO, ZERO, 1000.0_rk, ZERO, & params, ierr) if (ierr .ne. FEM_SUCCESS) call fail(81) call pstep_wall_init((/ ZERO, ZERO, ZERO /), & (/ ZERO, ZERO, ONE /), wall(1), ierr) if (ierr .ne. FEM_SUCCESS) call fail(82) call pstep_ctrl_init(0.01_rk, ZERO, (/ ZERO, ZERO, ZERO /), ZERO, & ctrl, ierr) if (ierr .ne. FEM_SUCCESS) call fail(83) call pstep_advance(ctrl, params, wall, 1, diag, ierr) if (ierr .ne. FEM_SUCCESS) call fail(84) if (diag%pair_count .ne. 0 .or. diag%wall_count .ne. 1) call fail(85) call check_close(diag%max_overlap, 0.10_rk, 86) call check_close(diag%elastic_energy, 5.0_rk, 87) call particle_get(slot, ext_id, active, position, velocity, radius, mass, & force, ierr) if (ierr .ne. FEM_SUCCESS) call fail(88) call check_vec(force, (/ ZERO, ZERO, 100.0_rk /), 89) call check_vec(velocity, (/ ZERO, ZERO, 0.50_rk /), 90) call check_vec(position, (/ ZERO, ZERO, 0.405_rk /), 91) call paudit_reset(audit) call paudit_rebound(slot, (/ ZERO, ZERO, ONE /), 0.10_rk, audit, ierr) if (ierr .ne. FEM_SUCCESS) call fail(92) if (audit%status .ne. PAUDIT_PASS) call fail(93) call check_close(audit%rebound_speed, 0.50_rk, 94) end subroutine check_wall_step subroutine check_bounds_and_dt() type(particle_contact_params) :: params integer :: s1 integer :: s2 integer :: ierr real(rk) :: dtcrit real(rk) :: max_force real(rk) :: sum_force real(rk) :: min_corner(3) real(rk) :: max_corner(3) call particle_reset() call particle_add(1, (/ ZERO, ZERO, ONE /), (/ ONE, ZERO, ZERO /), & 0.25_rk, 2.0_rk, s1, ierr) if (ierr .ne. FEM_SUCCESS) call fail(110) call particle_add(2, (/ ONE, ZERO, 2.0_rk /), (/ ZERO, ONE, ZERO /), & 0.50_rk, 3.0_rk, s2, ierr) if (ierr .ne. FEM_SUCCESS) call fail(111) call particle_contact_init(200.0_rk, ZERO, ZERO, ZERO, 800.0_rk, ZERO, & params, ierr) if (ierr .ne. FEM_SUCCESS) call fail(112) call pstep_estimate_dt(params, 0.2_rk, dtcrit, ierr) if (ierr .ne. FEM_SUCCESS) call fail(113) call check_close(dtcrit, 0.01_rk, 114) call particle_set_force(s1, (/ 3.0_rk, 4.0_rk, ZERO /), ierr) if (ierr .ne. FEM_SUCCESS) call fail(115) call particle_set_force(s2, (/ ZERO, ZERO, 12.0_rk /), ierr) if (ierr .ne. FEM_SUCCESS) call fail(116) call pstep_force_norms(max_force, sum_force, ierr) if (ierr .ne. FEM_SUCCESS) call fail(117) call check_close(max_force, 12.0_rk, 118) call check_close(sum_force, 17.0_rk, 119) call pstep_predict_bounds(0.5_rk, (/ ZERO, ZERO, -2.0_rk /), & min_corner, max_corner, ierr) if (ierr .ne. FEM_SUCCESS) call fail(120) call check_vec(min_corner, (/ 0.25_rk, -0.25_rk, 0.50_rk /), 121) call check_vec(max_corner, (/ 1.50_rk, ONE, 2.25_rk /), 122) end subroutine check_bounds_and_dt subroutine check_audit_paths() type(particle_contact_params) :: params type(particle_step_ctrl) :: ctrl type(particle_step_diag) :: diag type(particle_wall_def) :: walls(1) type(particle_audit_state) :: audit type(particle_audit_state) :: other type(particle_audit_state) :: merged integer :: s1 integer :: s2 integer :: ierr integer :: status integer :: checked_steps integer :: audit_status integer :: begin_trial_count integer :: rollback_requested_count integer :: rollback_ok_count integer :: rollback_failed_count integer :: commit_ok_count character(len=16) :: name character(len=64) :: audit_name real(rk) :: mass_error real(rk) :: mom_change real(rk) :: energy_change real(rk) :: overlap_ratio real(rk) :: rebound_speed call particle_reset() call particle_add(1, (/ ZERO, ZERO, ZERO /), (/ ZERO, ZERO, ZERO /), & 0.50_rk, ONE, s1, ierr) if (ierr .ne. FEM_SUCCESS) call fail(140) call particle_add(2, (/ 0.80_rk, ZERO, ZERO /), & (/ ZERO, ZERO, ZERO /), 0.50_rk, ONE, s2, ierr) if (ierr .ne. FEM_SUCCESS) call fail(141) call particle_contact_init(100.0_rk, ZERO, ZERO, ZERO, 100.0_rk, ZERO, & params, ierr) if (ierr .ne. FEM_SUCCESS) call fail(142) call pstep_ctrl_init(0.10_rk, ZERO, (/ ZERO, ZERO, ZERO /), ZERO, & ctrl, ierr) if (ierr .ne. FEM_SUCCESS) call fail(143) walls(1)%active = .false. call pstep_advance(ctrl, params, walls, 1, diag, ierr) if (ierr .ne. FEM_SUCCESS) call fail(144) call paudit_reset(audit) call nl_lifecycle_reset() call paudit_step(diag, 1.0e-12_rk, 10.0_rk, 10.0_rk, audit, ierr) if (ierr .ne. FEM_SUCCESS) call fail(145) call nl_lifecycle_get_audit(audit_status, audit_name, & begin_trial_count, rollback_requested_count, rollback_ok_count, & rollback_failed_count, commit_ok_count) if (commit_ok_count .ne. 1) call fail(157) if (rollback_failed_count .ne. 0) call fail(158) call paudit_overlap(diag, 0.50_rk, 0.3_rk, 0.6_rk, audit, ierr) if (ierr .ne. FEM_SUCCESS) call fail(146) if (audit%status .ne. PAUDIT_WARN) call fail(147) call paudit_values(audit, status, checked_steps, mass_error, mom_change, & energy_change, overlap_ratio, rebound_speed, ierr) if (ierr .ne. FEM_SUCCESS) call fail(148) if (status .ne. PAUDIT_WARN .or. checked_steps .ne. 1) call fail(149) call check_close(mass_error, ZERO, 150) call check_close(overlap_ratio, 0.40_rk, 151) call paudit_status_name(PAUDIT_WARN, name, ierr) if (ierr .ne. FEM_SUCCESS) call fail(152) if (trim(name) .ne. 'warn') call fail(153) call paudit_reset(other) call paudit_merge(audit, other, merged, ierr) if (ierr .ne. FEM_SUCCESS) call fail(154) if (merged%status .ne. PAUDIT_WARN) call fail(155) call paudit_status_name(99, name, ierr) if (ierr .eq. FEM_SUCCESS) call fail(156) end subroutine check_audit_paths subroutine check_error_paths() type(particle_contact_params) :: params type(particle_step_ctrl) :: ctrl type(particle_step_diag) :: diag type(particle_wall_def) :: wall(1) type(particle_audit_state) :: audit integer :: slot integer :: ierr real(rk) :: ratio call particle_reset() call particle_add(1, (/ ZERO, ZERO, ZERO /), (/ ZERO, ZERO, ZERO /), & 0.50_rk, ONE, slot, ierr) if (ierr .ne. FEM_SUCCESS) call fail(180) call particle_contact_init(100.0_rk, ZERO, ZERO, ZERO, 100.0_rk, ZERO, & params, ierr) if (ierr .ne. FEM_SUCCESS) call fail(181) call pstep_ctrl_init(0.01_rk, ZERO, (/ ZERO, ZERO, ZERO /), ZERO, & ctrl, ierr) if (ierr .ne. FEM_SUCCESS) call fail(182) call pstep_wall_init((/ ZERO, ZERO, ZERO /), & (/ ZERO, ZERO, ZERO /), wall(1), ierr) if (ierr .eq. FEM_SUCCESS) call fail(183) wall(1)%active = .true. wall(1)%normal = (/ ZERO, ZERO, 2.0_rk /) call pstep_advance(ctrl, params, wall, 1, diag, ierr) if (ierr .eq. FEM_SUCCESS) call fail(184) call pstep_contact_ratio(diag, ZERO, ratio, ierr) if (ierr .eq. FEM_SUCCESS) call fail(185) call paudit_reset(audit) call paudit_overlap(diag, 0.50_rk, 0.4_rk, 0.2_rk, audit, ierr) if (ierr .eq. FEM_SUCCESS) call fail(186) call paudit_rebound(99, (/ ZERO, ZERO, ONE /), ZERO, audit, ierr) if (ierr .eq. FEM_SUCCESS) call fail(187) end subroutine check_error_paths subroutine check_close(actual, expected, code) real(rk), intent(in) :: actual real(rk), intent(in) :: expected integer, intent(in) :: code if (abs(actual - expected) .gt. TOL * max(ONE, abs(expected))) call fail(code) end subroutine check_close subroutine check_vec(actual, expected, code) real(rk), intent(in) :: actual(3) real(rk), intent(in) :: expected(3) integer, intent(in) :: code if (maxval(abs(actual - expected)) .gt. TOL) call fail(code) end subroutine check_vec subroutine fail(code) integer, intent(in) :: code write(*,*) 'test_particle_step failed:', code stop 1 end subroutine fail end program test_particle_step