Release FemLite 0.3.3 stage baseline
This commit is contained in:
1 parent
7241b4f2bd
commit
3ad844ab55
73 files changed
+19184
-4676
No files matched your search
@@ -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)
|
||||
|
||||
@@ -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
@@ -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
|
||||
|
||||