Add implicit linear static solver
This commit is contained in:
@@ -50,6 +50,7 @@ add_library(femlite_core STATIC
|
||||
src/solver/fem_sparse_csr.f90
|
||||
src/solver/fem_linear_solver_cg.f90
|
||||
src/solver/fem_assembly_csr.f90
|
||||
src/solver/fem_solver_implicit.f90
|
||||
src/coupling/fem_coupling.f90
|
||||
src/boundary/fem_boundary.f90
|
||||
src/output/fem_output_csv.f90
|
||||
@@ -143,6 +144,13 @@ add_executable(test_element_stiffness
|
||||
target_link_libraries(test_element_stiffness PRIVATE femlite_core)
|
||||
femlite_apply_fortran_options(test_element_stiffness)
|
||||
|
||||
add_executable(test_solver_implicit
|
||||
tests/module/test_solver_implicit.f90
|
||||
)
|
||||
|
||||
target_link_libraries(test_solver_implicit PRIVATE femlite_core)
|
||||
femlite_apply_fortran_options(test_solver_implicit)
|
||||
|
||||
add_executable(perf_p1
|
||||
tests/performance/perf_p1.f90
|
||||
)
|
||||
@@ -199,3 +207,8 @@ add_test(NAME element_stiffness COMMAND test_element_stiffness)
|
||||
set_tests_properties(element_stiffness PROPERTIES
|
||||
WORKING_DIRECTORY "${CMAKE_SOURCE_DIR}"
|
||||
)
|
||||
|
||||
add_test(NAME solver_implicit COMMAND test_solver_implicit)
|
||||
set_tests_properties(solver_implicit PROPERTIES
|
||||
WORKING_DIRECTORY "${CMAKE_SOURCE_DIR}"
|
||||
)
|
||||
|
||||
@@ -9,6 +9,7 @@ module fem_api
|
||||
use fem_element_state
|
||||
use fem_element_mass
|
||||
use fem_element_internal
|
||||
use fem_solver_implicit
|
||||
use fem_coupling
|
||||
use fem_boundary
|
||||
use fem_output_csv
|
||||
@@ -854,6 +855,25 @@ contains
|
||||
ierr = FEM_SUCCESS
|
||||
end subroutine fem_run_explicit
|
||||
|
||||
subroutine fem_solve_implicit_linear(max_iter, tol, iter, res_norm, ierr)
|
||||
integer, intent(in) :: max_iter
|
||||
real(rk), intent(in) :: tol
|
||||
integer, intent(out) :: iter
|
||||
real(rk), intent(out) :: res_norm
|
||||
integer, intent(out) :: ierr
|
||||
|
||||
if (.not. api_initialized) then
|
||||
call error_set(FEM_ERR_INTERNAL, 'fem_solve_implicit_linear called before fem_initialize', ierr)
|
||||
return
|
||||
end if
|
||||
|
||||
call implicit_solve_linear_static(current_time, max_iter, tol, iter, res_norm, ierr)
|
||||
if (ierr .ne. FEM_SUCCESS) return
|
||||
|
||||
current_step = current_step + 1
|
||||
call log_info('implicit linear solve completed')
|
||||
end subroutine fem_solve_implicit_linear
|
||||
|
||||
subroutine fem_get_current_time(time, step, ierr)
|
||||
real(rk), intent(out) :: time
|
||||
integer, intent(out) :: step
|
||||
|
||||
@@ -0,0 +1,195 @@
|
||||
module fem_solver_implicit
|
||||
use fem_precision
|
||||
use fem_error
|
||||
use fem_database
|
||||
use fem_sparse_csr
|
||||
use fem_assembly_csr
|
||||
use fem_linear_solver_cg
|
||||
use fem_element_stiffness
|
||||
use fem_boundary
|
||||
implicit none
|
||||
|
||||
private
|
||||
|
||||
public :: implicit_solve_linear_static
|
||||
|
||||
contains
|
||||
|
||||
subroutine implicit_solve_linear_static(time, max_iter, tol, iter, res_norm, ierr)
|
||||
real(rk), intent(in) :: time
|
||||
integer, intent(in) :: max_iter
|
||||
real(rk), intent(in) :: tol
|
||||
integer, intent(out) :: iter
|
||||
real(rk), intent(out) :: res_norm
|
||||
integer, intent(out) :: ierr
|
||||
type(csr_matrix) :: kmat
|
||||
real(rk), allocatable :: rhs(:)
|
||||
integer :: stat
|
||||
|
||||
iter = 0
|
||||
res_norm = ZERO
|
||||
call csr_init(kmat)
|
||||
|
||||
if (ndof .le. 0) then
|
||||
call error_set(FEM_ERR_SOLVER, 'implicit linear solve requires positive ndof', ierr)
|
||||
return
|
||||
end if
|
||||
if (.not. allocated(u)) then
|
||||
call error_set(FEM_ERR_INTERNAL, 'implicit linear solve requires allocated solution vector', ierr)
|
||||
return
|
||||
end if
|
||||
|
||||
allocate(rhs(ndof), stat=stat)
|
||||
if (stat .ne. 0) then
|
||||
call error_set(FEM_ERR_SOLVER, 'failed to allocate implicit RHS', ierr)
|
||||
return
|
||||
end if
|
||||
rhs = ZERO
|
||||
|
||||
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 boundary_apply_prescribed_loads(time, ierr)
|
||||
if (ierr .ne. FEM_SUCCESS) go to 900
|
||||
|
||||
rhs = fext
|
||||
if (allocated(fsph)) rhs = rhs + fsph
|
||||
if (allocated(fcontact)) rhs = rhs + fcontact
|
||||
|
||||
call apply_implicit_dirichlet(kmat, rhs, time, ierr)
|
||||
if (ierr .ne. FEM_SUCCESS) go to 900
|
||||
|
||||
u = ZERO
|
||||
call linear_cg_solve(kmat, rhs, u, max_iter, tol, iter, res_norm, ierr)
|
||||
if (ierr .ne. FEM_SUCCESS) go to 900
|
||||
|
||||
if (allocated(v)) v = ZERO
|
||||
if (allocated(a)) a = ZERO
|
||||
if (allocated(vhalf)) vhalf = ZERO
|
||||
|
||||
900 continue
|
||||
call csr_free(kmat, stat)
|
||||
if (allocated(rhs)) deallocate(rhs)
|
||||
end subroutine implicit_solve_linear_static
|
||||
|
||||
subroutine assemble_linear_stiffness(kmat, ierr)
|
||||
type(csr_matrix), intent(inout) :: kmat
|
||||
integer, intent(out) :: ierr
|
||||
real(rk), allocatable :: ke(:,:)
|
||||
integer :: elem_dofs(MAX_ELEM_DOF)
|
||||
integer :: n_elem_dof
|
||||
integer :: elem
|
||||
integer :: stat
|
||||
|
||||
allocate(ke(MAX_ELEM_DOF,MAX_ELEM_DOF), stat=stat)
|
||||
if (stat .ne. 0) then
|
||||
call error_set(FEM_ERR_SOLVER, 'failed to allocate implicit element stiffness workspace', ierr)
|
||||
return
|
||||
end if
|
||||
|
||||
do elem = 1, nelem
|
||||
if (elem_status(elem) .ne. 0) cycle
|
||||
|
||||
call element_linear_stiffness(elem, elem_dofs, n_elem_dof, ke, ierr)
|
||||
if (ierr .ne. FEM_SUCCESS) go to 900
|
||||
call assembly_add_element_matrix(kmat, elem_dofs, n_elem_dof, ke, ierr)
|
||||
if (ierr .ne. FEM_SUCCESS) go to 900
|
||||
end do
|
||||
|
||||
ierr = FEM_SUCCESS
|
||||
|
||||
900 continue
|
||||
if (allocated(ke)) deallocate(ke)
|
||||
end subroutine assemble_linear_stiffness
|
||||
|
||||
subroutine apply_implicit_dirichlet(kmat, rhs, time, ierr)
|
||||
type(csr_matrix), intent(inout) :: kmat
|
||||
real(rk), intent(inout) :: rhs(:)
|
||||
real(rk), intent(in) :: time
|
||||
integer, intent(out) :: ierr
|
||||
integer :: item
|
||||
integer :: dof_num
|
||||
real(rk) :: scale
|
||||
|
||||
do item = 1, nbc
|
||||
scale = database_amplitude_value(bc_amp(item), time)
|
||||
do dof_num = bc_dof_start(item), bc_dof_end(item)
|
||||
call apply_bc_target(kmat, rhs, bc_target(item), dof_num, &
|
||||
scale * bc_value(item), ierr)
|
||||
if (ierr .ne. FEM_SUCCESS) return
|
||||
end do
|
||||
end do
|
||||
|
||||
ierr = FEM_SUCCESS
|
||||
end subroutine apply_implicit_dirichlet
|
||||
|
||||
subroutine apply_bc_target(kmat, rhs, target, dof_num, value, ierr)
|
||||
type(csr_matrix), intent(inout) :: kmat
|
||||
real(rk), intent(inout) :: rhs(:)
|
||||
character(len=*), intent(in) :: target
|
||||
integer, intent(in) :: dof_num
|
||||
real(rk), intent(in) :: value
|
||||
integer, intent(out) :: ierr
|
||||
integer :: node
|
||||
integer :: set_id
|
||||
integer :: pos
|
||||
integer :: external_id
|
||||
integer :: ios
|
||||
|
||||
if (dof_num .lt. 1 .or. dof_num .gt. NDOF_NODE) then
|
||||
call error_set(FEM_ERR_INPUT, 'implicit boundary dof is outside 1..6', ierr)
|
||||
return
|
||||
end if
|
||||
|
||||
read(target,*,iostat=ios) external_id
|
||||
if (ios .eq. 0) then
|
||||
node = database_find_node(external_id)
|
||||
if (node .eq. 0) then
|
||||
call error_set(FEM_ERR_INPUT, 'implicit boundary references unknown node', ierr)
|
||||
return
|
||||
end if
|
||||
call apply_bc_node(kmat, rhs, node, dof_num, value, ierr)
|
||||
return
|
||||
end if
|
||||
|
||||
set_id = database_find_nset(target)
|
||||
if (set_id .eq. 0) then
|
||||
call error_set(FEM_ERR_INPUT, 'implicit boundary references unknown node set', ierr)
|
||||
return
|
||||
end if
|
||||
|
||||
do pos = nset_start(set_id), nset_start(set_id) + nset_count(set_id) - 1
|
||||
node = database_find_node(nset_items(pos))
|
||||
if (node .eq. 0) then
|
||||
call error_set(FEM_ERR_INPUT, 'implicit boundary node set contains unknown node', ierr)
|
||||
return
|
||||
end if
|
||||
call apply_bc_node(kmat, rhs, node, dof_num, value, ierr)
|
||||
if (ierr .ne. FEM_SUCCESS) return
|
||||
end do
|
||||
|
||||
ierr = FEM_SUCCESS
|
||||
end subroutine apply_bc_target
|
||||
|
||||
subroutine apply_bc_node(kmat, rhs, node, dof_num, value, ierr)
|
||||
type(csr_matrix), intent(inout) :: kmat
|
||||
real(rk), intent(inout) :: rhs(:)
|
||||
integer, intent(in) :: node
|
||||
integer, intent(in) :: dof_num
|
||||
real(rk), intent(in) :: value
|
||||
integer, intent(out) :: ierr
|
||||
integer :: dof
|
||||
|
||||
dof = dof_id(dof_num,node)
|
||||
if (dof .gt. 0) then
|
||||
call csr_apply_dirichlet(kmat, rhs, dof, value, ierr)
|
||||
if (ierr .ne. FEM_SUCCESS) return
|
||||
end if
|
||||
|
||||
ierr = FEM_SUCCESS
|
||||
end subroutine apply_bc_node
|
||||
|
||||
end module fem_solver_implicit
|
||||
@@ -0,0 +1,179 @@
|
||||
program test_solver_implicit
|
||||
use fem_precision
|
||||
use fem_error
|
||||
use fem_database
|
||||
use fem_solver_implicit
|
||||
implicit none
|
||||
|
||||
real(rk), parameter :: TOL = 1.0e-10_rk
|
||||
|
||||
call check_single_dof_pull()
|
||||
call check_prescribed_value()
|
||||
|
||||
contains
|
||||
|
||||
subroutine check_single_dof_pull()
|
||||
integer :: ierr
|
||||
integer :: iter
|
||||
real(rk) :: res_norm
|
||||
real(rk) :: expected
|
||||
integer :: dof
|
||||
|
||||
call setup_pull_model(ierr)
|
||||
if (ierr .ne. FEM_SUCCESS) call fail(1)
|
||||
|
||||
call implicit_solve_linear_static(ZERO, 50, 1.0e-12_rk, iter, res_norm, ierr)
|
||||
if (ierr .ne. FEM_SUCCESS) call fail(2)
|
||||
if (iter .le. 0 .or. iter .gt. 5) call fail(3)
|
||||
if (res_norm .gt. TOL) call fail(4)
|
||||
|
||||
dof = dof_id(1,2)
|
||||
expected = 5.0_rk / 6.0_rk
|
||||
call check_close(u(dof), expected, 5)
|
||||
call check_close(u(dof_id(2,2)), ZERO, 6)
|
||||
call check_close(u(dof_id(3,2)), ZERO, 7)
|
||||
call check_close(maxval(abs(v)), ZERO, 8)
|
||||
call check_close(maxval(abs(a)), ZERO, 9)
|
||||
|
||||
call database_finalize(ierr)
|
||||
if (ierr .ne. FEM_SUCCESS) call fail(10)
|
||||
end subroutine check_single_dof_pull
|
||||
|
||||
subroutine check_prescribed_value()
|
||||
integer :: ierr
|
||||
integer :: iter
|
||||
real(rk) :: res_norm
|
||||
integer :: dof
|
||||
|
||||
call setup_prescribed_model(ierr)
|
||||
if (ierr .ne. FEM_SUCCESS) call fail(20)
|
||||
|
||||
call implicit_solve_linear_static(ZERO, 50, 1.0e-12_rk, iter, res_norm, ierr)
|
||||
if (ierr .ne. FEM_SUCCESS) call fail(21)
|
||||
if (res_norm .gt. TOL) call fail(22)
|
||||
|
||||
dof = dof_id(1,2)
|
||||
call check_close(u(dof), 0.25_rk, 23)
|
||||
call check_close(maxval(abs(v)), ZERO, 24)
|
||||
call check_close(maxval(abs(a)), ZERO, 25)
|
||||
|
||||
call database_finalize(ierr)
|
||||
if (ierr .ne. FEM_SUCCESS) call fail(26)
|
||||
end subroutine check_prescribed_value
|
||||
|
||||
subroutine setup_pull_model(ierr)
|
||||
integer, intent(out) :: ierr
|
||||
|
||||
call setup_base_tet(4, 1, ierr)
|
||||
if (ierr .ne. FEM_SUCCESS) return
|
||||
|
||||
bc_target(1) = '1'
|
||||
bc_dof_start(1) = 1
|
||||
bc_dof_end(1) = 3
|
||||
bc_value(1) = ZERO
|
||||
|
||||
bc_target(2) = '2'
|
||||
bc_dof_start(2) = 2
|
||||
bc_dof_end(2) = 3
|
||||
bc_value(2) = ZERO
|
||||
|
||||
bc_target(3) = '3'
|
||||
bc_dof_start(3) = 1
|
||||
bc_dof_end(3) = 3
|
||||
bc_value(3) = ZERO
|
||||
|
||||
bc_target(4) = '4'
|
||||
bc_dof_start(4) = 1
|
||||
bc_dof_end(4) = 3
|
||||
bc_value(4) = ZERO
|
||||
|
||||
cload_target(1) = '2'
|
||||
cload_dof(1) = 1
|
||||
cload_value(1) = 5.0_rk
|
||||
ierr = FEM_SUCCESS
|
||||
end subroutine setup_pull_model
|
||||
|
||||
subroutine setup_prescribed_model(ierr)
|
||||
integer, intent(out) :: ierr
|
||||
|
||||
call setup_base_tet(5, 0, ierr)
|
||||
if (ierr .ne. FEM_SUCCESS) return
|
||||
|
||||
bc_target(1) = '1'
|
||||
bc_dof_start(1) = 1
|
||||
bc_dof_end(1) = 3
|
||||
bc_value(1) = ZERO
|
||||
|
||||
bc_target(2) = '2'
|
||||
bc_dof_start(2) = 1
|
||||
bc_dof_end(2) = 1
|
||||
bc_value(2) = 0.25_rk
|
||||
|
||||
bc_target(3) = '2'
|
||||
bc_dof_start(3) = 2
|
||||
bc_dof_end(3) = 3
|
||||
bc_value(3) = ZERO
|
||||
|
||||
bc_target(4) = '3'
|
||||
bc_dof_start(4) = 1
|
||||
bc_dof_end(4) = 3
|
||||
bc_value(4) = ZERO
|
||||
|
||||
bc_target(5) = '4'
|
||||
bc_dof_start(5) = 1
|
||||
bc_dof_end(5) = 3
|
||||
bc_value(5) = ZERO
|
||||
ierr = FEM_SUCCESS
|
||||
end subroutine setup_prescribed_model
|
||||
|
||||
subroutine setup_base_tet(num_bc, num_cload, ierr)
|
||||
integer, intent(in) :: num_bc
|
||||
integer, intent(in) :: num_cload
|
||||
integer, intent(out) :: ierr
|
||||
integer :: i
|
||||
|
||||
call database_allocate_model(4, 1, 0, 0, 0, 0, 1, 0, 0, &
|
||||
0, 0, num_bc, num_cload, 0, ierr)
|
||||
if (ierr .ne. FEM_SUCCESS) return
|
||||
|
||||
do i = 1, 4
|
||||
node_id_ext(i) = i
|
||||
coord0(:,i) = ZERO
|
||||
coord(:,i) = ZERO
|
||||
end do
|
||||
coord0(:,2) = (/ ONE, ZERO, ZERO /)
|
||||
coord0(:,3) = (/ ZERO, ONE, ZERO /)
|
||||
coord0(:,4) = (/ ZERO, ZERO, ONE /)
|
||||
|
||||
elem_id_ext(1) = 1
|
||||
elem_type(1) = 'C3D4'
|
||||
elem_nnode(1) = 4
|
||||
elem_conn(:,1) = 0
|
||||
elem_conn(1:4,1) = (/ 1, 2, 3, 4 /)
|
||||
elem_mat(1) = 1
|
||||
elem_sec(1) = 1
|
||||
|
||||
mat_name(1) = 'MAT'
|
||||
mat_density(1) = ONE
|
||||
mat_e(1) = 30.0_rk
|
||||
mat_nu(1) = 0.25_rk
|
||||
|
||||
call database_assign_dofs(ierr)
|
||||
end subroutine setup_base_tet
|
||||
|
||||
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) call fail(code)
|
||||
end subroutine check_close
|
||||
|
||||
subroutine fail(code)
|
||||
integer, intent(in) :: code
|
||||
|
||||
write(*,*) 'test_solver_implicit failed:', code
|
||||
stop 1
|
||||
end subroutine fail
|
||||
|
||||
end program test_solver_implicit
|
||||
Reference in New Issue
Block a user