501 lines
19 KiB
Fortran
501 lines
19 KiB
Fortran
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
|