Release FemLite 0.3.3 stage baseline

This commit is contained in:
shenw committed 2026-06-24 17:29:36 +08:00
1 parent 7241b4f2bd
commit 3ad844ab55
73 files changed
+19184 -4676

No files matched your search

+5 -36
View File
@@ -2,6 +2,7 @@ module fem_assembly_csr
use fem_precision
use fem_error
use fem_database
use fem_database_surface, only: db_contact_elem_match
use fem_element_topology
use fem_sparse_csr
implicit none
@@ -83,15 +84,8 @@ contains
integer, allocatable :: row_cols(:,:)
integer, allocatable :: row_ptr(:)
integer, allocatable :: col_ind(:)
integer :: elem
integer :: i
integer :: j
integer :: pos
integer :: row
integer :: col
integer :: stat
integer :: max_raw
integer :: n_elem_dof
integer :: elem, i, j, pos, row, col
integer :: stat, max_raw, n_elem_dof
integer :: elem_dofs(MAX_ELEM_DOF)
if (ndof .le. 0) then
@@ -488,34 +482,9 @@ contains
logical function contact_target_matches_elem(elem, target)
integer, intent(in) :: elem
character(len=*), intent(in) :: target
character(len=NAME_LEN) :: local_target
integer :: external_id
integer :: ios
integer :: set_id
integer :: pos
local_target = adjustl(target)
if (len_trim(local_target) .eq. 0 .or. trim(local_target) .eq. 'ALL' .or. &
trim(local_target) .eq. 'all') then
contact_target_matches_elem = .true.
return
end if
read(local_target,*,iostat=ios) external_id
if (ios .eq. 0) then
contact_target_matches_elem = elem_id_ext(elem) .eq. external_id
return
end if
set_id = database_find_elset(local_target)
contact_target_matches_elem = .false.
if (set_id .eq. 0) return
do pos = elset_start(set_id), elset_start(set_id) + elset_count(set_id) - 1
if (elset_items(pos) .eq. elem_id_ext(elem)) then
contact_target_matches_elem = .true.
return
end if
end do
contact_target_matches_elem = &
db_contact_elem_match(elem_id_ext(elem), target)
end function contact_target_matches_elem
subroutine mpc_term_dof(item, dof, ierr)
+67 -3
View File
@@ -20,8 +20,10 @@ contains
real(rk), intent(out) :: res_norm
integer, intent(out) :: ierr
real(rk), allocatable :: r(:)
real(rk), allocatable :: z(:)
real(rk), allocatable :: p(:)
real(rk), allocatable :: ap(:)
real(rk), allocatable :: diag_inv(:)
real(rk) :: alpha
real(rk) :: beta
real(rk) :: denom
@@ -57,17 +59,22 @@ contains
end if
n = a%nrow
allocate(r(n), p(n), ap(n), stat=stat)
allocate(r(n), z(n), p(n), ap(n), diag_inv(n), stat=stat)
if (stat .ne. 0) then
call error_set(FEM_ERR_SOLVER, 'failed to allocate CG workspace', ierr)
return
end if
diag_inv = ONE
call build_jacobi_inverse(a, diag_inv, ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
call csr_matvec(a, x, ap, ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
r = b - ap
p = r
call apply_jacobi_inverse(diag_inv, r, z)
p = z
norm_b = sqrt(dot_product(b, b))
threshold = tol * max(ONE, norm_b)
rsold = dot_product(r, r)
@@ -76,6 +83,11 @@ contains
ierr = FEM_SUCCESS
go to 900
end if
rsold = dot_product(r, z)
if (rsold .le. tiny(ONE)) then
call error_set(FEM_ERR_SOLVER, 'CG solver detected invalid preconditioned residual', ierr)
go to 900
end if
do iter = 1, max_iter
call csr_matvec(a, p, ap, ierr)
@@ -98,8 +110,14 @@ contains
go to 900
end if
call apply_jacobi_inverse(diag_inv, r, z)
rsnew = dot_product(r, z)
if (rsnew .le. tiny(ONE)) then
call error_set(FEM_ERR_SOLVER, 'CG solver detected invalid preconditioned update', ierr)
go to 900
end if
beta = rsnew / rsold
p = r + beta * p
p = z + beta * p
rsold = rsnew
end do
@@ -108,8 +126,54 @@ contains
900 continue
if (allocated(r)) deallocate(r)
if (allocated(z)) deallocate(z)
if (allocated(p)) deallocate(p)
if (allocated(ap)) deallocate(ap)
if (allocated(diag_inv)) deallocate(diag_inv)
end subroutine linear_cg_solve
subroutine build_jacobi_inverse(a, diag_inv, ierr)
type(csr_matrix), intent(in) :: a
real(rk), intent(inout) :: diag_inv(:)
integer, intent(out) :: ierr
real(rk) :: diag
integer :: row
integer :: k
diag_inv = ONE
if (size(diag_inv) .ne. a%nrow) then
call error_set(FEM_ERR_SOLVER, 'Jacobi preconditioner size mismatch', ierr)
return
end if
do row = 1, a%nrow
diag = ZERO
do k = a%row_ptr(row), a%row_ptr(row+1) - 1
if (a%col_ind(k) .eq. row) then
diag = a%val(k)
exit
end if
end do
if (abs(diag) .gt. tiny(ONE)) then
diag_inv(row) = ONE / abs(diag)
end if
end do
ierr = FEM_SUCCESS
end subroutine build_jacobi_inverse
subroutine apply_jacobi_inverse(diag_inv, r, z)
real(rk), intent(in) :: diag_inv(:)
real(rk), intent(in) :: r(:)
real(rk), intent(out) :: z(:)
integer :: i
integer :: n
n = min(size(z), min(size(diag_inv), size(r)))
z = ZERO
do i = 1, n
z(i) = diag_inv(i) * r(i)
end do
end subroutine apply_jacobi_inverse
end module fem_linear_solver_cg
+358 -284
View File
@@ -240,60 +240,18 @@ contains
real(rk), intent(out) :: res_norm
integer, intent(out) :: ierr
type(csr_matrix) :: kmat
real(rk), allocatable :: rhs(:)
real(rk), allocatable :: external(:)
real(rk), allocatable :: u_pred(:)
real(rk), allocatable :: v_pred(:)
real(rk), allocatable :: damp_vec(:)
real(rk), allocatable :: kdamp(:)
real(rk), allocatable :: damping_force(:)
real(rk), allocatable :: rhs(:), external(:), u_pred(:), v_pred(:)
real(rk), allocatable :: damp_vec(:), kdamp(:), damping_force(:)
real(rk), allocatable :: k_val_original(:)
real(rk) :: a0
real(rk) :: a1
real(rk) :: mass_scale
real(rk) :: stiff_scale
real(rk) :: target_time
integer :: dof
real(rk) :: a0, a1, mass_scale, stiff_scale, target_time
integer :: stat
iter = 0
res_norm = ZERO
call csr_init(kmat)
if (ndof .le. 0) then
call error_set(FEM_ERR_SOLVER, 'implicit Newmark requires positive ndof', ierr)
return
end if
if (dt .le. ZERO) then
call error_set(FEM_ERR_SOLVER, 'implicit Newmark time step must be positive', ierr)
return
end if
if (beta .le. ZERO) then
call error_set(FEM_ERR_SOLVER, 'implicit Newmark beta must be positive', ierr)
return
end if
if (gamma .le. ZERO) then
call error_set(FEM_ERR_SOLVER, 'implicit Newmark gamma must be positive', ierr)
return
end if
if (rayleigh_alpha_mass .lt. ZERO .or. rayleigh_beta_stiffness .lt. ZERO) then
call error_set(FEM_ERR_SOLVER, 'Rayleigh damping factors must be non-negative', ierr)
return
end if
if (.not. allocated(u) .or. .not. allocated(v) .or. .not. allocated(a)) then
call error_set(FEM_ERR_INTERNAL, 'implicit Newmark requires kinematic vectors', ierr)
return
end if
if (.not. allocated(mass_diag)) then
call error_set(FEM_ERR_INTERNAL, 'implicit Newmark requires mass vector', ierr)
return
end if
do dof = 1, ndof
if (mass_diag(dof) .le. ZERO) then
call error_set(FEM_ERR_SOLVER, 'implicit Newmark found non-positive lumped mass', ierr)
return
end if
end do
call newmark_linear_validate(dt, beta, gamma, ierr)
if (ierr .ne. FEM_SUCCESS) return
allocate(rhs(ndof), external(ndof), u_pred(ndof), v_pred(ndof), &
damp_vec(ndof), kdamp(ndof), damping_force(ndof), stat=stat)
@@ -302,12 +260,8 @@ contains
return
end if
a0 = ONE / (beta * dt * dt)
a1 = gamma / (beta * dt)
target_time = current_time + dt
u_pred = u + dt * v + dt * dt * (HALF - beta) * a
v_pred = v + dt * (ONE - gamma) * a
damp_vec = a1 * u_pred - v_pred
call newmark_linear_predict(dt, beta, gamma, u_pred, v_pred, damp_vec, &
a0, a1, target_time)
call assembly_build_csr_pattern(kmat, ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
@@ -351,28 +305,11 @@ contains
call linear_cg_solve(kmat, rhs, u, max_iter, tol, iter, res_norm, ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
a = a0 * (u - u_pred)
v = v_pred + gamma * dt * a
if (allocated(vhalf)) vhalf = v - HALF * dt * a
call boundary_apply_dirichlet(target_time, ierr)
call newmark_linear_finish(dt, gamma, a0, target_time, kmat, &
k_val_original, external, kdamp, &
damping_force, u_pred, v_pred, ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
call element_compute_internal_force(ierr, dt)
if (ierr .ne. FEM_SUCCESS) go to 900
call assemble_nonlinear_external(target_time, external, ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
damping_force = ZERO
if (rayleigh_alpha_mass .gt. ZERO) then
damping_force = damping_force + rayleigh_alpha_mass * mass_diag * v
end if
if (rayleigh_beta_stiffness .gt. ZERO) then
call csr_saved_matvec(kmat, k_val_original, v, kdamp, ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
damping_force = damping_force + rayleigh_beta_stiffness * kdamp
end if
if (allocated(freaction)) freaction = fint + mass_diag * a + damping_force - external
ierr = FEM_SUCCESS
900 continue
@@ -387,6 +324,106 @@ contains
if (allocated(k_val_original)) deallocate(k_val_original)
end subroutine implicit_advance_newmark_linear
subroutine newmark_linear_validate(dt, beta, gamma, ierr)
real(rk), intent(in) :: dt
real(rk), intent(in) :: beta
real(rk), intent(in) :: gamma
integer, intent(out) :: ierr
integer :: dof
if (ndof .le. 0) then
call error_set(FEM_ERR_SOLVER, 'implicit Newmark requires positive ndof', ierr)
return
end if
if (dt .le. ZERO) then
call error_set(FEM_ERR_SOLVER, 'implicit Newmark time step must be positive', ierr)
return
end if
if (beta .le. ZERO .or. gamma .le. ZERO) then
call error_set(FEM_ERR_SOLVER, 'implicit Newmark parameters must be positive', ierr)
return
end if
if (rayleigh_alpha_mass .lt. ZERO .or. rayleigh_beta_stiffness .lt. ZERO) then
call error_set(FEM_ERR_SOLVER, 'Rayleigh damping factors must be non-negative', ierr)
return
end if
if (.not. allocated(u) .or. .not. allocated(v) .or. .not. allocated(a)) then
call error_set(FEM_ERR_INTERNAL, 'implicit Newmark requires kinematic vectors', ierr)
return
end if
if (.not. allocated(mass_diag)) then
call error_set(FEM_ERR_INTERNAL, 'implicit Newmark requires mass vector', ierr)
return
end if
do dof = 1, ndof
if (mass_diag(dof) .le. ZERO) then
call error_set(FEM_ERR_SOLVER, 'implicit Newmark found non-positive lumped mass', ierr)
return
end if
end do
ierr = FEM_SUCCESS
end subroutine newmark_linear_validate
subroutine newmark_linear_predict(dt, beta, gamma, u_pred, v_pred, &
damp_vec, a0, a1, target_time)
real(rk), intent(in) :: dt
real(rk), intent(in) :: beta
real(rk), intent(in) :: gamma
real(rk), intent(out) :: u_pred(ndof)
real(rk), intent(out) :: v_pred(ndof)
real(rk), intent(out) :: damp_vec(ndof)
real(rk), intent(out) :: a0
real(rk), intent(out) :: a1
real(rk), intent(out) :: target_time
a0 = ONE / (beta * dt * dt)
a1 = gamma / (beta * dt)
target_time = current_time + dt
u_pred = u + dt * v + dt * dt * (HALF - beta) * a
v_pred = v + dt * (ONE - gamma) * a
damp_vec = a1 * u_pred - v_pred
end subroutine newmark_linear_predict
subroutine newmark_linear_finish(dt, gamma, a0, target_time, kmat, kcopy, &
external, kdamp, damping_force, u_pred, &
v_pred, ierr)
real(rk), intent(in) :: dt
real(rk), intent(in) :: gamma
real(rk), intent(in) :: a0
real(rk), intent(in) :: target_time
type(csr_matrix), intent(in) :: kmat
real(rk), intent(in) :: kcopy(:)
real(rk), intent(inout) :: external(ndof)
real(rk), intent(inout) :: kdamp(ndof)
real(rk), intent(inout) :: damping_force(ndof)
real(rk), intent(in) :: u_pred(ndof)
real(rk), intent(in) :: v_pred(ndof)
integer, intent(out) :: ierr
a = a0 * (u - u_pred)
v = v_pred + gamma * dt * a
if (allocated(vhalf)) vhalf = v - HALF * dt * a
call boundary_apply_dirichlet(target_time, ierr)
if (ierr .ne. FEM_SUCCESS) return
call element_compute_internal_force(ierr, dt)
if (ierr .ne. FEM_SUCCESS) return
call assemble_nonlinear_external(target_time, external, ierr)
if (ierr .ne. FEM_SUCCESS) return
damping_force = ZERO
if (rayleigh_alpha_mass .gt. ZERO) then
damping_force = damping_force + rayleigh_alpha_mass * mass_diag * v
end if
if (rayleigh_beta_stiffness .gt. ZERO) then
call csr_saved_matvec(kmat, kcopy, v, kdamp, ierr)
if (ierr .ne. FEM_SUCCESS) return
damping_force = damping_force + rayleigh_beta_stiffness * kdamp
end if
if (allocated(freaction)) freaction = fint + mass_diag * a + damping_force - external
ierr = FEM_SUCCESS
end subroutine newmark_linear_finish
subroutine implicit_newmark_nonlinear_step(dt, beta, gamma, max_iter, tol, &
iter_used, res_norm, ierr)
real(rk), intent(in) :: dt
@@ -398,58 +435,25 @@ contains
real(rk), intent(out) :: res_norm
integer, intent(out) :: ierr
type(csr_matrix) :: kmat
real(rk), allocatable :: residual(:)
real(rk), allocatable :: external(:)
real(rk), allocatable :: rhs_corr(:)
real(rk), allocatable :: du(:)
real(rk), allocatable :: u_pred(:)
real(rk), allocatable :: v_pred(:)
real(rk), allocatable :: u_start(:)
real(rk), allocatable :: v_start(:)
real(rk), allocatable :: a_start(:)
real(rk), allocatable :: vhalf_start(:)
real(rk), allocatable :: u_base(:)
real(rk), allocatable :: kdamp(:)
real(rk), allocatable :: damping_force(:)
real(rk), allocatable :: k_val_original(:)
real(rk) :: a0
real(rk) :: a1
real(rk) :: mass_scale
real(rk) :: stiff_scale
real(rk) :: target_time
real(rk) :: ref_norm
real(rk) :: cg_res
real(rk) :: trial_res_norm
real(rk) :: trial_ref_norm
integer :: dof
integer :: iter
integer :: cg_iter
integer :: stat
integer :: state_ierr
real(rk), allocatable :: residual(:), external(:), rhs_corr(:), du(:)
real(rk), allocatable :: u_pred(:), v_pred(:), u_start(:), v_start(:)
real(rk), allocatable :: a_start(:), vhalf_start(:), u_base(:)
real(rk), allocatable :: kdamp(:), damping_force(:)
real(rk) :: a0, a1, target_time, ref_norm
real(rk) :: trial_res_norm, trial_ref_norm
integer :: iter, stat, state_ierr
logical :: converged
iter_used = 0
res_norm = ZERO
ref_norm = ONE
trial_res_norm = ZERO
trial_ref_norm = ONE
converged = .false.
call csr_init(kmat)
if (ndof .le. 0) then
call error_set(FEM_ERR_SOLVER, 'nonlinear Newmark requires positive ndof', ierr)
return
end if
if (dt .le. ZERO) then
call error_set(FEM_ERR_SOLVER, 'nonlinear Newmark time step must be positive', ierr)
return
end if
if (beta .le. ZERO) then
call error_set(FEM_ERR_SOLVER, 'nonlinear Newmark beta must be positive', ierr)
return
end if
if (gamma .le. ZERO) then
call error_set(FEM_ERR_SOLVER, 'nonlinear Newmark gamma must be positive', ierr)
return
end if
call newmark_linear_validate(dt, beta, gamma, ierr)
if (ierr .ne. FEM_SUCCESS) return
if (max_iter .le. 0) then
call error_set(FEM_ERR_SOLVER, 'nonlinear Newmark max_iter must be positive', ierr)
return
@@ -458,51 +462,19 @@ contains
call error_set(FEM_ERR_SOLVER, 'nonlinear Newmark tolerance must be positive', ierr)
return
end if
if (rayleigh_alpha_mass .lt. ZERO .or. rayleigh_beta_stiffness .lt. ZERO) then
call error_set(FEM_ERR_SOLVER, 'Rayleigh damping factors must be non-negative', ierr)
return
end if
if (.not. allocated(u) .or. .not. allocated(v) .or. .not. allocated(a)) then
call error_set(FEM_ERR_INTERNAL, 'nonlinear Newmark requires kinematic vectors', ierr)
return
end if
if (.not. allocated(mass_diag)) then
call error_set(FEM_ERR_INTERNAL, 'nonlinear Newmark requires mass vector', ierr)
return
end if
do dof = 1, ndof
if (mass_diag(dof) .le. ZERO) then
call error_set(FEM_ERR_SOLVER, 'nonlinear Newmark found non-positive lumped mass', ierr)
return
end if
end do
allocate(residual(ndof), external(ndof), rhs_corr(ndof), du(ndof), &
u_pred(ndof), v_pred(ndof), u_start(ndof), v_start(ndof), &
a_start(ndof), vhalf_start(ndof), u_base(ndof), &
kdamp(ndof), damping_force(ndof), stat=stat)
a_start(ndof), vhalf_start(ndof), u_base(ndof), kdamp(ndof), &
damping_force(ndof), stat=stat)
if (stat .ne. 0) then
call error_set(FEM_ERR_SOLVER, 'failed to allocate nonlinear Newmark workspace', ierr)
return
go to 900
end if
u_start = u
v_start = v
a_start = a
if (allocated(vhalf)) then
vhalf_start = vhalf
else
vhalf_start = ZERO
end if
a0 = ONE / (beta * dt * dt)
a1 = gamma / (beta * dt)
target_time = current_time + dt
u_pred = u + dt * v + dt * dt * (HALF - beta) * a
v_pred = v + dt * (ONE - gamma) * a
u = u_pred
call boundary_apply_dirichlet(target_time, ierr)
call newmark_nl_save_state(u_start, v_start, a_start, vhalf_start)
call newmark_nl_start(dt, beta, gamma, u_pred, v_pred, a0, a1, &
target_time, ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
call element_state_begin_trial(ierr)
@@ -512,45 +484,10 @@ contains
call element_state_restore_trial(ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
a = a0 * (u - u_pred)
v = v_pred + gamma * dt * a
if (allocated(vhalf)) vhalf = v - HALF * dt * a
call element_compute_internal_force(ierr, dt)
call newmark_nl_eval_resid(target_time, dt, a0, gamma, u_pred, v_pred, &
kmat, external, residual, damping_force, &
kdamp, res_norm, ref_norm, ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
call assemble_nonlinear_external(target_time, external, ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
call csr_free(kmat, stat)
call assembly_build_csr_pattern(kmat, ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
call assemble_linear_stiffness(kmat, ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
if (allocated(k_val_original)) deallocate(k_val_original)
allocate(k_val_original(kmat%nnz), stat=stat)
if (stat .ne. 0) then
call error_set(FEM_ERR_SOLVER, 'failed to allocate nonlinear Newmark stiffness copy', ierr)
go to 900
end if
k_val_original = kmat%val
damping_force = ZERO
if (rayleigh_alpha_mass .gt. ZERO) then
damping_force = damping_force + rayleigh_alpha_mass * mass_diag * v
end if
if (rayleigh_beta_stiffness .gt. ZERO) then
call csr_saved_matvec(kmat, k_val_original, v, kdamp, ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
damping_force = damping_force + rayleigh_beta_stiffness * kdamp
end if
residual = external - fint - mass_diag * a - damping_force
call zero_prescribed_residual(residual, ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
res_norm = sqrt(sum(residual * residual))
ref_norm = max(ONE, sqrt(sum(external * external)))
iter_used = iter
if (res_norm .le. tol .or. res_norm / ref_norm .le. tol) then
converged = .true.
@@ -558,30 +495,14 @@ contains
freaction = fint + mass_diag * a + damping_force - external
end if
call csr_free(kmat, stat)
if (allocated(k_val_original)) deallocate(k_val_original)
exit
end if
stiff_scale = ONE + a1 * rayleigh_beta_stiffness
mass_scale = a0 + a1 * rayleigh_alpha_mass
if (abs(stiff_scale - ONE) .gt. tiny(ONE)) kmat%val = stiff_scale * kmat%val
call add_lumped_mass_diagonal(kmat, mass_scale, ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
call apply_nl_external_tangent(kmat, target_time, a1, ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
rhs_corr = residual
call apply_implicit_dirichlet_zero(kmat, rhs_corr, ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
du = ZERO
call linear_cg_solve(kmat, rhs_corr, du, max_iter * 20, tol, &
cg_iter, cg_res, ierr)
call newmark_nl_solve_corr(kmat, target_time, a0, a1, residual, &
rhs_corr, du, max_iter, tol, ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
call csr_free(kmat, stat)
if (allocated(k_val_original)) deallocate(k_val_original)
u_base = u
if (use_line_search) then
call nonlinear_newmark_line_search(target_time, dt, a0, a1, &
@@ -609,10 +530,7 @@ contains
900 continue
if (ierr .ne. FEM_SUCCESS) then
if (allocated(u_start)) u = u_start
if (allocated(v_start)) v = v_start
if (allocated(a_start)) a = a_start
if (allocated(vhalf_start) .and. allocated(vhalf)) vhalf = vhalf_start
call newmark_nl_restore_state(u_start, v_start, a_start, vhalf_start)
call element_state_abort_trial(state_ierr)
end if
call csr_free(kmat, stat)
@@ -629,9 +547,145 @@ contains
if (allocated(u_base)) deallocate(u_base)
if (allocated(kdamp)) deallocate(kdamp)
if (allocated(damping_force)) deallocate(damping_force)
if (allocated(k_val_original)) deallocate(k_val_original)
end subroutine implicit_newmark_nonlinear_step
subroutine newmark_nl_save_state(u_start, v_start, a_start, vhalf_start)
real(rk), intent(out) :: u_start(ndof)
real(rk), intent(out) :: v_start(ndof)
real(rk), intent(out) :: a_start(ndof)
real(rk), intent(out) :: vhalf_start(ndof)
u_start = u
v_start = v
a_start = a
if (allocated(vhalf)) then
vhalf_start = vhalf
else
vhalf_start = ZERO
end if
end subroutine newmark_nl_save_state
subroutine newmark_nl_restore_state(u_start, v_start, a_start, vhalf_start)
real(rk), intent(in) :: u_start(ndof)
real(rk), intent(in) :: v_start(ndof)
real(rk), intent(in) :: a_start(ndof)
real(rk), intent(in) :: vhalf_start(ndof)
u = u_start
v = v_start
a = a_start
if (allocated(vhalf)) vhalf = vhalf_start
end subroutine newmark_nl_restore_state
subroutine newmark_nl_start(dt, beta, gamma, u_pred, v_pred, a0, a1, &
target_time, ierr)
real(rk), intent(in) :: dt
real(rk), intent(in) :: beta
real(rk), intent(in) :: gamma
real(rk), intent(out) :: u_pred(ndof)
real(rk), intent(out) :: v_pred(ndof)
real(rk), intent(out) :: a0
real(rk), intent(out) :: a1
real(rk), intent(out) :: target_time
integer, intent(out) :: ierr
a0 = ONE / (beta * dt * dt)
a1 = gamma / (beta * dt)
target_time = current_time + dt
u_pred = u + dt * v + dt * dt * (HALF - beta) * a
v_pred = v + dt * (ONE - gamma) * a
u = u_pred
call boundary_apply_dirichlet(target_time, ierr)
end subroutine newmark_nl_start
subroutine newmark_nl_eval_resid(target_time, dt, a0, gamma, u_pred, &
v_pred, kmat, external, residual, &
damping_force, kdamp, res_norm, ref_norm, &
ierr)
real(rk), intent(in) :: target_time
real(rk), intent(in) :: dt
real(rk), intent(in) :: a0
real(rk), intent(in) :: gamma
real(rk), intent(in) :: u_pred(ndof)
real(rk), intent(in) :: v_pred(ndof)
type(csr_matrix), intent(inout) :: kmat
real(rk), intent(inout) :: external(ndof)
real(rk), intent(inout) :: residual(ndof)
real(rk), intent(inout) :: damping_force(ndof)
real(rk), intent(inout) :: kdamp(ndof)
real(rk), intent(out) :: res_norm
real(rk), intent(out) :: ref_norm
integer, intent(out) :: ierr
integer :: stat
a = a0 * (u - u_pred)
v = v_pred + gamma * dt * a
if (allocated(vhalf)) vhalf = v - HALF * dt * a
call element_compute_internal_force(ierr, dt)
if (ierr .ne. FEM_SUCCESS) return
call assemble_nonlinear_external(target_time, external, ierr)
if (ierr .ne. FEM_SUCCESS) return
call csr_free(kmat, stat)
call assembly_build_csr_pattern(kmat, ierr)
if (ierr .ne. FEM_SUCCESS) return
call assemble_linear_stiffness(kmat, ierr)
if (ierr .ne. FEM_SUCCESS) return
damping_force = ZERO
if (rayleigh_alpha_mass .gt. ZERO) then
damping_force = damping_force + rayleigh_alpha_mass * mass_diag * v
end if
if (rayleigh_beta_stiffness .gt. ZERO) then
call csr_matvec(kmat, v, kdamp, ierr)
if (ierr .ne. FEM_SUCCESS) return
damping_force = damping_force + rayleigh_beta_stiffness * kdamp
end if
residual = external - fint - mass_diag * a - damping_force
call zero_prescribed_residual(residual, ierr)
if (ierr .ne. FEM_SUCCESS) return
res_norm = sqrt(sum(residual * residual))
ref_norm = max(ONE, sqrt(sum(external * external)))
ierr = FEM_SUCCESS
end subroutine newmark_nl_eval_resid
subroutine newmark_nl_solve_corr(kmat, target_time, a0, a1, residual, &
rhs_corr, du, max_iter, tol, ierr)
type(csr_matrix), intent(inout) :: kmat
real(rk), intent(in) :: target_time
real(rk), intent(in) :: a0
real(rk), intent(in) :: a1
real(rk), intent(in) :: residual(ndof)
real(rk), intent(inout) :: rhs_corr(ndof)
real(rk), intent(inout) :: du(ndof)
integer, intent(in) :: max_iter
real(rk), intent(in) :: tol
integer, intent(out) :: ierr
real(rk) :: mass_scale, stiff_scale, cg_res
integer :: cg_iter
integer :: stat
stiff_scale = ONE + a1 * rayleigh_beta_stiffness
mass_scale = a0 + a1 * rayleigh_alpha_mass
if (abs(stiff_scale - ONE) .gt. tiny(ONE)) kmat%val = stiff_scale * kmat%val
call add_lumped_mass_diagonal(kmat, mass_scale, ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
call apply_nl_external_tangent(kmat, target_time, a1, ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
rhs_corr = residual
call apply_implicit_dirichlet_zero(kmat, rhs_corr, ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
call linear_cg_solve(kmat, rhs_corr, du, max_iter * 20, tol, &
cg_iter, cg_res, ierr)
900 continue
call csr_free(kmat, stat)
end subroutine newmark_nl_solve_corr
subroutine nonlinear_newmark_line_search(target_time, dt, a0, a1, &
u_pred, v_pred, u_base, du, &
current_res_norm, residual, external, &
@@ -641,15 +695,15 @@ contains
real(rk), intent(in) :: dt
real(rk), intent(in) :: a0
real(rk), intent(in) :: a1
real(rk), intent(in) :: u_pred(:)
real(rk), intent(in) :: v_pred(:)
real(rk), intent(in) :: u_base(:)
real(rk), intent(in) :: du(:)
real(rk), intent(in) :: u_pred(ndof)
real(rk), intent(in) :: v_pred(ndof)
real(rk), intent(in) :: u_base(ndof)
real(rk), intent(in) :: du(ndof)
real(rk), intent(in) :: current_res_norm
real(rk), intent(inout) :: residual(:)
real(rk), intent(inout) :: external(:)
real(rk), intent(inout) :: damping_force(:)
real(rk), intent(inout) :: kdamp(:)
real(rk), intent(inout) :: residual(ndof)
real(rk), intent(inout) :: external(ndof)
real(rk), intent(inout) :: damping_force(ndof)
real(rk), intent(inout) :: kdamp(ndof)
real(rk), intent(out) :: trial_res_norm
real(rk), intent(out) :: trial_ref_norm
integer, intent(out) :: ierr
@@ -659,11 +713,8 @@ contains
real(rk) :: reduction
real(rk) :: accept_ratio
if (size(u_pred) .ne. ndof .or. size(v_pred) .ne. ndof .or. &
size(u_base) .ne. ndof .or. size(du) .ne. ndof) then
call error_set(FEM_ERR_SOLVER, 'Newmark line search vector size mismatch', ierr)
return
end if
trial_res_norm = current_res_norm
trial_ref_norm = ONE
min_alpha = line_search_min_alpha
if (min_alpha .le. ZERO .or. min_alpha .gt. ONE) min_alpha = 0.125_rk
@@ -701,12 +752,12 @@ contains
real(rk), intent(in) :: dt
real(rk), intent(in) :: a0
real(rk), intent(in) :: a1
real(rk), intent(in) :: u_pred(:)
real(rk), intent(in) :: v_pred(:)
real(rk), intent(inout) :: residual(:)
real(rk), intent(inout) :: external(:)
real(rk), intent(inout) :: damping_force(:)
real(rk), intent(inout) :: kdamp(:)
real(rk), intent(in) :: u_pred(ndof)
real(rk), intent(in) :: v_pred(ndof)
real(rk), intent(inout) :: residual(ndof)
real(rk), intent(inout) :: external(ndof)
real(rk), intent(inout) :: damping_force(ndof)
real(rk), intent(inout) :: kdamp(ndof)
real(rk), intent(out) :: res_norm
real(rk), intent(out) :: ref_norm
integer, intent(out) :: ierr
@@ -714,6 +765,8 @@ contains
real(rk), allocatable :: kcopy(:)
integer :: stat
res_norm = ZERO
ref_norm = ONE
call csr_init(ktmp)
call boundary_apply_dirichlet(target_time, ierr)
@@ -774,7 +827,6 @@ contains
integer, intent(out) :: iter_used
real(rk), intent(out) :: res_norm
integer, intent(out) :: ierr
type(csr_matrix) :: kmat
real(rk), allocatable :: residual(:)
real(rk), allocatable :: external(:)
real(rk), allocatable :: rhs_corr(:)
@@ -782,11 +834,9 @@ contains
real(rk), allocatable :: u_start(:)
real(rk), allocatable :: u_base(:)
real(rk) :: ref_norm
real(rk) :: cg_res
real(rk) :: trial_res_norm
real(rk) :: trial_ref_norm
integer :: iter
integer :: cg_iter
integer :: stat
integer :: state_ierr
logical :: converged
@@ -794,6 +844,8 @@ contains
iter_used = 0
res_norm = ZERO
ref_norm = ONE
trial_res_norm = ZERO
trial_ref_norm = ONE
converged = .false.
allocate(residual(ndof), external(ndof), rhs_corr(ndof), du(ndof), &
u_start(ndof), u_base(ndof), stat=stat)
@@ -814,18 +866,9 @@ contains
call element_state_restore_trial(ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
call element_compute_internal_force(ierr, dt_inc)
call static_eval_residual(target_time, dt_inc, residual, external, &
res_norm, ref_norm, ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
call assemble_nonlinear_external(target_time, external, ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
residual = external - fint
call zero_prescribed_residual(residual, ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
res_norm = sqrt(sum(residual * residual))
ref_norm = max(ONE, sqrt(sum(external * external)))
iter_used = iter
if (res_norm .le. tol .or. res_norm / ref_norm .le. tol) then
converged = .true.
@@ -833,34 +876,9 @@ contains
exit
end if
call csr_init(kmat)
call assembly_build_csr_pattern(kmat, ierr)
if (ierr .ne. FEM_SUCCESS) then
call csr_free(kmat, stat)
go to 900
end if
call assemble_linear_stiffness(kmat, ierr)
if (ierr .ne. FEM_SUCCESS) then
call csr_free(kmat, stat)
go to 900
end if
call apply_nl_external_tangent(kmat, target_time, ZERO, ierr)
if (ierr .ne. FEM_SUCCESS) then
call csr_free(kmat, stat)
go to 900
end if
rhs_corr = residual
call apply_implicit_dirichlet_zero(kmat, rhs_corr, ierr)
if (ierr .ne. FEM_SUCCESS) then
call csr_free(kmat, stat)
go to 900
end if
du = ZERO
call linear_cg_solve(kmat, rhs_corr, du, max_iter * 20, tol, &
cg_iter, cg_res, ierr)
call csr_free(kmat, stat)
call static_solve_correction(target_time, residual, rhs_corr, du, &
max_iter, tol, ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
u_base = u
@@ -899,16 +917,74 @@ contains
if (allocated(u_base)) deallocate(u_base)
end subroutine nonlinear_static_increment
subroutine static_eval_residual(target_time, dt_inc, residual, external, &
res_norm, ref_norm, ierr)
real(rk), intent(in) :: target_time
real(rk), intent(in) :: dt_inc
real(rk), intent(inout) :: residual(ndof)
real(rk), intent(inout) :: external(ndof)
real(rk), intent(out) :: res_norm
real(rk), intent(out) :: ref_norm
integer, intent(out) :: ierr
call element_compute_internal_force(ierr, dt_inc)
if (ierr .ne. FEM_SUCCESS) return
call assemble_nonlinear_external(target_time, external, ierr)
if (ierr .ne. FEM_SUCCESS) return
residual = external - fint
call zero_prescribed_residual(residual, ierr)
if (ierr .ne. FEM_SUCCESS) return
res_norm = sqrt(sum(residual * residual))
ref_norm = max(ONE, sqrt(sum(external * external)))
ierr = FEM_SUCCESS
end subroutine static_eval_residual
subroutine static_solve_correction(target_time, residual, rhs_corr, du, &
max_iter, tol, ierr)
real(rk), intent(in) :: target_time
real(rk), intent(in) :: residual(ndof)
real(rk), intent(inout) :: rhs_corr(ndof)
real(rk), intent(inout) :: du(ndof)
integer, intent(in) :: max_iter
real(rk), intent(in) :: tol
integer, intent(out) :: ierr
type(csr_matrix) :: kmat
real(rk) :: cg_res
integer :: cg_iter
integer :: stat
call csr_init(kmat)
call assembly_build_csr_pattern(kmat, ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
call assemble_linear_stiffness(kmat, ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
call apply_nl_external_tangent(kmat, target_time, ZERO, ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
rhs_corr = residual
call apply_implicit_dirichlet_zero(kmat, rhs_corr, ierr)
if (ierr .ne. FEM_SUCCESS) go to 900
call linear_cg_solve(kmat, rhs_corr, du, max_iter * 20, tol, &
cg_iter, cg_res, ierr)
900 continue
call csr_free(kmat, stat)
end subroutine static_solve_correction
subroutine nonlinear_static_line_search(target_time, dt_inc, u_base, du, &
current_res_norm, residual, external, &
trial_res_norm, trial_ref_norm, ierr)
real(rk), intent(in) :: target_time
real(rk), intent(in) :: dt_inc
real(rk), intent(in) :: u_base(:)
real(rk), intent(in) :: du(:)
real(rk), intent(in) :: u_base(ndof)
real(rk), intent(in) :: du(ndof)
real(rk), intent(in) :: current_res_norm
real(rk), intent(inout) :: residual(:)
real(rk), intent(inout) :: external(:)
real(rk), intent(inout) :: residual(ndof)
real(rk), intent(inout) :: external(ndof)
real(rk), intent(out) :: trial_res_norm
real(rk), intent(out) :: trial_ref_norm
integer, intent(out) :: ierr
@@ -918,10 +994,8 @@ contains
real(rk) :: reduction
real(rk) :: accept_ratio
if (size(u_base) .ne. ndof .or. size(du) .ne. ndof) then
call error_set(FEM_ERR_SOLVER, 'static line search vector size mismatch', ierr)
return
end if
trial_res_norm = current_res_norm
trial_ref_norm = ONE
min_alpha = line_search_min_alpha
if (min_alpha .le. ZERO .or. min_alpha .gt. ONE) min_alpha = 0.125_rk
Reference in new issue
Block a user
Blocking a user prevents them from interacting with repositories, such as opening or commenting on pull requests or issues. Learn more about blocking a user.