program test_rigid_roller use fem_precision use fem_error use fem_rigid_cylinder use fem_rigid_roller use fem_roller_schedule use fem_roll_metrics implicit none real(rk), parameter :: TOL = 1.0e-10_rk call check_cylinder_geometry() call check_cylinder_velocity_frame() call check_roller_pose_spin() call check_roller_contact_kin() call check_roller_spin_traction() call check_roller_schedule() call check_roll_metrics() call check_error_paths() contains subroutine check_cylinder_geometry() real(rk) :: center(3) real(rk) :: axis(3) real(rk) :: point(3) real(rk) :: projected(3) real(rk) :: normal(3) real(rk) :: gap real(rk) :: penetration real(rk) :: axial real(rk) :: k_normal real(rk) :: k_axial integer :: ierr center = (/ ZERO, ZERO, ZERO /) axis = (/ ZERO, ZERO, ONE /) point = (/ 3.0_rk, ZERO, 4.0_rk /) call cyl_validate(center, axis, 2.0_rk, ierr) if (ierr .ne. FEM_SUCCESS) call fail(10) call cyl_gap_normal(point, center, axis, 2.0_rk, gap, normal, ierr) if (ierr .ne. FEM_SUCCESS) call fail(11) call check_close(gap, ONE, 12) call check_vec(normal, (/ ONE, ZERO, ZERO /), 13) call cyl_project_point(point, center, axis, 2.0_rk, projected, axial, ierr) if (ierr .ne. FEM_SUCCESS) call fail(14) call check_vec(projected, (/ 2.0_rk, ZERO, 4.0_rk /), 15) call check_close(axial, 4.0_rk, 16) point = (/ 1.5_rk, ZERO, ZERO /) call cyl_contact_measure(point, center, axis, 2.0_rk, gap, penetration, & projected, normal, axial, ierr) if (ierr .ne. FEM_SUCCESS) call fail(17) call check_close(gap, -0.5_rk, 18) call check_close(penetration, 0.5_rk, 19) call check_vec(projected, (/ 2.0_rk, ZERO, ZERO /), 20) point = (/ ZERO, ZERO, 2.0_rk /) call cyl_gap_normal(point, center, axis, 2.0_rk, gap, normal, ierr) if (ierr .ne. FEM_SUCCESS) call fail(21) call check_close(gap, -2.0_rk, 22) call check_close(norm3_local(normal), ONE, 23) call check_close(dot_product(normal, axis), ZERO, 24) call cyl_curvature(2.0_rk, k_normal, k_axial, ierr) if (ierr .ne. FEM_SUCCESS) call fail(25) call check_close(k_normal, 0.5_rk, 26) call check_close(k_axial, ZERO, 27) end subroutine check_cylinder_geometry subroutine check_cylinder_velocity_frame() real(rk) :: center(3) real(rk) :: axis(3) real(rk) :: point(3) real(rk) :: trans(3) real(rk) :: velocity(3) real(rk) :: normal(3) real(rk) :: axial(3) real(rk) :: roll(3) real(rk) :: tangent(3) real(rk) :: slip integer :: ierr center = ZERO axis = (/ ZERO, ZERO, ONE /) point = (/ 2.0_rk, ZERO, ZERO /) trans = (/ ONE, ZERO, ZERO /) call cyl_surface_velocity(point, center, axis, trans, 10.0_rk, velocity, & ierr) if (ierr .ne. FEM_SUCCESS) call fail(40) call check_vec(velocity, (/ ONE, 20.0_rk, ZERO /), 41) call cyl_surface_frame(point, center, axis, 2.0_rk, normal, axial, roll, & ierr) if (ierr .ne. FEM_SUCCESS) call fail(42) call check_vec(normal, (/ ONE, ZERO, ZERO /), 43) call check_vec(axial, (/ ZERO, ZERO, ONE /), 44) call check_vec(roll, (/ ZERO, ONE, ZERO /), 45) call cyl_tangent_slip((/ 3.0_rk, 4.0_rk, 5.0_rk /), normal, tangent, slip, & ierr) if (ierr .ne. FEM_SUCCESS) call fail(46) call check_vec(tangent, (/ ZERO, 4.0_rk, 5.0_rk /), 47) call check_close(slip, sqrt(41.0_rk), 48) end subroutine check_cylinder_velocity_frame subroutine check_roller_pose_spin() real(rk) :: center0(3) real(rk) :: feed_dir(3) real(rk) :: down_dir(3) real(rk) :: center(3) real(rk) :: next_center(3) real(rk) :: axis(3) real(rk) :: axis_unit(3) real(rk) :: feed_unit(3) real(rk) :: down_unit(3) real(rk) :: velocity(3) real(rk) :: spin integer :: ierr center0 = (/ ONE, 2.0_rk, 3.0_rk /) feed_dir = (/ 2.0_rk, ZERO, ZERO /) down_dir = (/ ZERO, ZERO, -3.0_rk /) call roller_pose_linear(center0, feed_dir, down_dir, 4.0_rk, 0.5_rk, & center, ierr) if (ierr .ne. FEM_SUCCESS) call fail(60) call check_vec(center, (/ 5.0_rk, 2.0_rk, 2.5_rk /), 61) call roller_increment_pose(center, feed_dir, down_dir, -ONE, ONE, & next_center, ierr) if (ierr .ne. FEM_SUCCESS) call fail(62) call check_vec(next_center, (/ 4.0_rk, 2.0_rk, 1.5_rk /), 63) call roller_spin_from_feed(2.0_rk, 0.5_rk, spin, ierr) if (ierr .ne. FEM_SUCCESS) call fail(64) call check_close(spin, 4.0_rk, 65) call roller_step_velocity(feed_dir, down_dir, 3.0_rk, -2.0_rk, velocity, & ierr) if (ierr .ne. FEM_SUCCESS) call fail(66) call check_vec(velocity, (/ 3.0_rk, ZERO, 2.0_rk /), 67) axis = (/ ZERO, ZERO, ONE /) call roller_build_feed_frame(axis, (/ ONE, ONE, ONE /), axis_unit, & feed_unit, down_unit, ierr) if (ierr .ne. FEM_SUCCESS) call fail(68) call check_vec(axis_unit, (/ ZERO, ZERO, ONE /), 69) call check_close(dot_product(axis_unit, feed_unit), ZERO, 70) call check_close(dot_product(axis_unit, down_unit), ZERO, 71) call check_close(dot_product(feed_unit, down_unit), ZERO, 72) call check_close(norm3_local(feed_unit), ONE, 73) call check_close(norm3_local(down_unit), ONE, 74) end subroutine check_roller_pose_spin subroutine check_roller_contact_kin() real(rk) :: point(3) real(rk) :: body_velocity(3) real(rk) :: center(3) real(rk) :: axis(3) real(rk) :: roller_velocity(3) real(rk) :: gap real(rk) :: penetration real(rk) :: normal(3) real(rk) :: roll_dir(3) real(rk) :: axial_dir(3) real(rk) :: rel_velocity(3) real(rk) :: normal_speed real(rk) :: slip_speed real(rk) :: roll_speed real(rk) :: axial_speed real(rk) :: ratio real(rk) :: friction_force(3) real(rk) :: power integer :: ierr point = (/ 2.0_rk, ZERO, ZERO /) body_velocity = ZERO center = ZERO axis = (/ ZERO, ZERO, ONE /) roller_velocity = (/ ONE, ZERO, ZERO /) call roller_contact_kin(point, body_velocity, center, axis, 2.0_rk, & roller_velocity, 0.5_rk, gap, penetration, & normal, roll_dir, axial_dir, rel_velocity, & normal_speed, slip_speed, ierr) if (ierr .ne. FEM_SUCCESS) call fail(90) call check_close(gap, ZERO, 91) call check_close(penetration, ZERO, 92) call check_vec(normal, (/ ONE, ZERO, ZERO /), 93) call check_vec(roll_dir, (/ ZERO, ONE, ZERO /), 94) call check_vec(axial_dir, (/ ZERO, ZERO, ONE /), 95) call check_vec(rel_velocity, (/ -ONE, -ONE, ZERO /), 96) call check_close(normal_speed, -ONE, 97) call check_close(slip_speed, ONE, 98) call roller_roll_components(rel_velocity, normal, roll_dir, axial_dir, & normal_speed, roll_speed, axial_speed, & slip_speed, ierr) if (ierr .ne. FEM_SUCCESS) call fail(99) call check_close(normal_speed, -ONE, 100) call check_close(roll_speed, -ONE, 101) call check_close(axial_speed, ZERO, 102) call check_close(slip_speed, ONE, 103) call roller_stick_slip_ratio(0.25_rk, 2.0_rk, ratio, ierr) if (ierr .ne. FEM_SUCCESS) call fail(104) call check_close(ratio, 0.125_rk, 105) call roller_traction_from_mu(10.0_rk, 0.2_rk, (/ ZERO, -3.0_rk, ZERO /), & friction_force, ierr) if (ierr .ne. FEM_SUCCESS) call fail(106) call check_vec(friction_force, (/ ZERO, 2.0_rk, ZERO /), 107) call roller_friction_work_rate((/ ZERO, -3.0_rk, ZERO /), friction_force, & power, ierr) if (ierr .ne. FEM_SUCCESS) call fail(108) call check_close(power, -6.0_rk, 109) end subroutine check_roller_contact_kin subroutine check_roller_spin_traction() real(rk) :: point(3) real(rk) :: body_velocity(3) real(rk) :: center(3) real(rk) :: axis(3) real(rk) :: roller_velocity(3) real(rk) :: gap real(rk) :: penetration real(rk) :: normal(3) real(rk) :: roll_dir(3) real(rk) :: axial_dir(3) real(rk) :: rel_spin(3) real(rk) :: rel_no_spin(3) real(rk) :: normal_speed real(rk) :: slip_spin real(rk) :: slip_no_spin real(rk) :: tangent_spin(3) real(rk) :: tangent_no_spin(3) real(rk) :: force_spin(3) real(rk) :: force_no_spin(3) integer :: ierr point = (/ 2.0_rk, ZERO, ZERO /) body_velocity = ZERO center = ZERO axis = (/ ZERO, ZERO, ONE /) roller_velocity = (/ ZERO, 0.5_rk, ZERO /) call roller_contact_kin(point, body_velocity, center, axis, 2.0_rk, & roller_velocity, 0.25_rk, gap, penetration, & normal, roll_dir, axial_dir, rel_spin, & normal_speed, slip_spin, ierr) if (ierr .ne. FEM_SUCCESS) call fail(110) tangent_spin = rel_spin - normal_speed * normal call roller_contact_kin(point, body_velocity, center, axis, 2.0_rk, & roller_velocity, ZERO, gap, penetration, & normal, roll_dir, axial_dir, rel_no_spin, & normal_speed, slip_no_spin, ierr) if (ierr .ne. FEM_SUCCESS) call fail(111) tangent_no_spin = rel_no_spin - normal_speed * normal call check_close(slip_spin, ONE, 112) call check_close(slip_no_spin, 0.5_rk, 113) call roller_regularized_traction(10.0_rk, 0.3_rk, tangent_spin, ONE, & force_spin, ierr) if (ierr .ne. FEM_SUCCESS) call fail(114) call roller_regularized_traction(10.0_rk, 0.3_rk, tangent_no_spin, ONE, & force_no_spin, ierr) if (ierr .ne. FEM_SUCCESS) call fail(115) if (norm3_local(force_spin) .le. norm3_local(force_no_spin)) call fail(116) if (abs(norm3_local(force_spin) - norm3_local(force_no_spin)) .le. & 0.5_rk) call fail(117) end subroutine check_roller_spin_traction subroutine check_roller_schedule() type(roller_step_state) :: step type(roller_step_state) :: next_step type(roller_step_state) :: blended type(roller_step_state) :: chain(2) real(rk) :: feed real(rk) :: down real(rk) :: spin real(rk) :: pressure real(rk) :: feed_rate real(rk) :: down_rate real(rk) :: spin_rate real(rk) :: pressure_rate real(rk) :: fraction real(rk) :: duration real(rk) :: clamped real(rk) :: max_gap logical :: inside integer :: ierr call roller_step_init(ZERO, 10.0_rk, ZERO, 20.0_rk, ZERO, -ONE, & ZERO, 4.0_rk, 5.0_rk, 15.0_rk, step, ierr) if (ierr .ne. FEM_SUCCESS) call fail(130) call roller_step_eval(step, 5.0_rk, feed, down, spin, pressure, ierr) if (ierr .ne. FEM_SUCCESS) call fail(131) call check_close(feed, 10.0_rk, 132) call check_close(down, -0.5_rk, 133) call check_close(spin, 2.0_rk, 134) call check_close(pressure, 10.0_rk, 135) call roller_step_eval(step, -ONE, feed, down, spin, pressure, ierr) if (ierr .ne. FEM_SUCCESS) call fail(136) call check_close(feed, ZERO, 137) call roller_step_eval(step, 11.0_rk, feed, down, spin, pressure, ierr) if (ierr .ne. FEM_SUCCESS) call fail(138) call check_close(feed, 20.0_rk, 139) call roller_step_rates(step, feed_rate, down_rate, spin_rate, & pressure_rate, ierr) if (ierr .ne. FEM_SUCCESS) call fail(140) call check_close(feed_rate, 2.0_rk, 141) call check_close(down_rate, -0.1_rk, 142) call check_close(spin_rate, 0.4_rk, 143) call check_close(pressure_rate, ONE, 144) call roller_step_fraction(step, 2.5_rk, fraction, ierr) if (ierr .ne. FEM_SUCCESS) call fail(145) call check_close(fraction, 0.25_rk, 146) call roller_step_duration(step, duration, ierr) if (ierr .ne. FEM_SUCCESS) call fail(147) call check_close(duration, 10.0_rk, 148) call roller_step_clamp_time(step, -2.0_rk, clamped, ierr) if (ierr .ne. FEM_SUCCESS) call fail(149) call check_close(clamped, ZERO, 150) call roller_step_contains(step, 7.5_rk, inside, ierr) if (ierr .ne. FEM_SUCCESS) call fail(151) if (.not. inside) call fail(152) call roller_step_init(10.0_rk, 15.0_rk, 20.0_rk, 24.0_rk, -ONE, & -2.0_rk, 4.0_rk, 5.0_rk, 15.0_rk, 12.0_rk, & next_step, ierr) if (ierr .ne. FEM_SUCCESS) call fail(153) call roller_step_blend(step, next_step, 0.5_rk, blended, ierr) if (ierr .ne. FEM_SUCCESS) call fail(154) call check_close(blended%time_start, 5.0_rk, 155) call check_close(blended%feed_end, 22.0_rk, 156) chain(1) = step chain(2) = next_step call roller_step_chain_check(2, chain, max_gap, ierr) if (ierr .ne. FEM_SUCCESS) call fail(157) call check_close(max_gap, ZERO, 158) call roller_step_end_values(next_step, feed, down, spin, pressure, ierr) if (ierr .ne. FEM_SUCCESS) call fail(159) call check_close(feed, 24.0_rk, 160) call check_close(down, -2.0_rk, 161) call check_close(spin, 5.0_rk, 162) call check_close(pressure, 12.0_rk, 163) end subroutine check_roller_schedule subroutine check_roll_metrics() type(roll_metrics_state) :: state type(roll_metrics_state) :: other type(roll_metrics_state) :: merged integer :: active_count real(rk) :: contact_width real(rk) :: max_penetration real(rk) :: normal_force real(rk) :: friction_power real(rk) :: mean_slip real(rk) :: mean_pressure real(rk) :: energy real(rk) :: ratio real(rk) :: pressure real(rk) :: residual_disp real(rk) :: springback_disp real(rk) :: springback_ratio integer :: ierr call roll_metrics_reset(state) call roll_metrics_add_sample(state, .true., 0.10_rk, -ONE, 5.0_rk, & 2.0_rk, 1.5_rk, 0.5_rk, ierr) if (ierr .ne. FEM_SUCCESS) call fail(180) call roll_metrics_add_sample(state, .true., 0.30_rk, 2.0_rk, 7.0_rk, & 4.0_rk, 0.5_rk, ONE, ierr) if (ierr .ne. FEM_SUCCESS) call fail(181) call roll_metrics_add_sample(state, .false., ZERO, 9.0_rk, ZERO, ZERO, & ZERO, ZERO, ierr) if (ierr .ne. FEM_SUCCESS) call fail(182) call roll_metrics_summary(state, active_count, contact_width, & max_penetration, normal_force, friction_power, & mean_slip, mean_pressure, ierr) if (ierr .ne. FEM_SUCCESS) call fail(183) if (active_count .ne. 2) call fail(184) call check_close(contact_width, 3.0_rk, 185) call check_close(max_penetration, 0.30_rk, 186) call check_close(normal_force, 12.0_rk, 187) call check_close(friction_power, 5.0_rk, 188) call check_close(mean_slip, 3.0_rk, 189) call check_close(mean_pressure, 8.0_rk, 190) call roll_metrics_energy_step(friction_power, 0.2_rk, energy, ierr) if (ierr .ne. FEM_SUCCESS) call fail(191) call check_close(energy, ONE, 192) call roll_metrics_active_ratio(state, ratio, ierr) if (ierr .ne. FEM_SUCCESS) call fail(193) call check_close(ratio, 2.0_rk / 3.0_rk, 194) call roll_metrics_pressure_sample(9.0_rk, 3.0_rk, pressure, ierr) if (ierr .ne. FEM_SUCCESS) call fail(195) call check_close(pressure, 3.0_rk, 196) call roll_metrics_residual_disp(0.5_rk, 2.0_rk, residual_disp, ierr) if (ierr .ne. FEM_SUCCESS) call fail(201) call check_close(residual_disp, ONE, 202) call roll_metrics_springback(2.0_rk, 1.25_rk, springback_disp, & springback_ratio, ierr) if (ierr .ne. FEM_SUCCESS) call fail(203) call check_close(springback_disp, 0.75_rk, 204) call check_close(springback_ratio, 0.375_rk, 205) call roll_metrics_reset(other) call roll_metrics_add_sample(other, .true., 0.05_rk, 4.0_rk, 2.0_rk, & ONE, ONE, ONE, ierr) if (ierr .ne. FEM_SUCCESS) call fail(197) call roll_metrics_merge(state, other, merged, ierr) if (ierr .ne. FEM_SUCCESS) call fail(198) call roll_metrics_contact_width(merged, contact_width, ierr) if (ierr .ne. FEM_SUCCESS) call fail(199) call check_close(contact_width, 5.0_rk, 200) end subroutine check_roll_metrics subroutine check_error_paths() real(rk) :: center(3) real(rk) :: axis(3) real(rk) :: gap real(rk) :: normal(3) real(rk) :: spin real(rk) :: pressure type(roller_step_state) :: bad_step type(roll_metrics_state) :: state integer :: ierr center = ZERO axis = ZERO call cyl_validate(center, axis, ONE, ierr) if (ierr .eq. FEM_SUCCESS) call fail(220) axis = (/ ZERO, ZERO, ONE /) call cyl_gap_normal((/ ONE, ZERO, ZERO /), center, axis, -ONE, gap, & normal, ierr) if (ierr .eq. FEM_SUCCESS) call fail(221) call roller_spin_from_feed(ONE, ZERO, spin, ierr) if (ierr .eq. FEM_SUCCESS) call fail(222) call roller_step_init(ONE, ZERO, ZERO, ZERO, ZERO, ZERO, ZERO, ZERO, & ZERO, ZERO, bad_step, ierr) if (ierr .eq. FEM_SUCCESS) call fail(223) call roller_step_init(ZERO, ONE, ZERO, ZERO, ZERO, ZERO, ZERO, ZERO, & -ONE, ZERO, bad_step, ierr) if (ierr .eq. FEM_SUCCESS) call fail(224) call roll_metrics_reset(state) call roll_metrics_add_sample(state, .true., -ONE, ZERO, ZERO, ZERO, ZERO, & ZERO, ierr) if (ierr .eq. FEM_SUCCESS) call fail(225) call roll_metrics_energy_step(ONE, -ONE, pressure, ierr) if (ierr .eq. FEM_SUCCESS) call fail(226) call roll_metrics_pressure_sample(ONE, ZERO, pressure, ierr) if (ierr .eq. FEM_SUCCESS) call fail(227) call roll_metrics_residual_disp(ONE, -ONE, pressure, ierr) if (ierr .eq. FEM_SUCCESS) call fail(228) call roll_metrics_springback(ZERO, ONE, spin, pressure, ierr) if (ierr .eq. FEM_SUCCESS) call fail(229) end subroutine check_error_paths 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 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 real(rk) function norm3_local(vector) real(rk), intent(in) :: vector(3) norm3_local = sqrt(dot_product(vector, vector)) end function norm3_local subroutine fail(code) integer, intent(in) :: code write(*,*) 'test_rigid_roller failed:', code stop 1 end subroutine fail end program test_rigid_roller