549 lines
17 KiB
Fortran
549 lines
17 KiB
Fortran
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
|
|
|
|
private
|
|
|
|
integer, parameter :: MAX_ELEM_DOF = MAX_NEN * NDOF_NODE
|
|
|
|
public :: MAX_ELEM_DOF
|
|
public :: assembly_get_element_dofs
|
|
public :: assembly_build_csr_pattern
|
|
public :: assembly_add_element_matrix
|
|
public :: assembly_add_element_vector
|
|
|
|
contains
|
|
|
|
subroutine assembly_get_element_dofs(elem, elem_dofs, n_elem_dof, ierr)
|
|
integer, intent(in) :: elem
|
|
integer, intent(out) :: elem_dofs(:)
|
|
integer, intent(out) :: n_elem_dof
|
|
integer, intent(out) :: ierr
|
|
integer :: local_node
|
|
integer :: node
|
|
integer :: dof_num
|
|
integer :: last_dof
|
|
integer :: dof
|
|
|
|
n_elem_dof = 0
|
|
elem_dofs = 0
|
|
|
|
if (elem .lt. 1 .or. elem .gt. nelem) then
|
|
call error_set(FEM_ERR_MESH, 'assembly element index is out of range', ierr)
|
|
return
|
|
end if
|
|
if (.not. allocated(dof_id)) then
|
|
call error_set(FEM_ERR_INTERNAL, 'assembly requires assigned dof_id table', ierr)
|
|
return
|
|
end if
|
|
if (.not. allocated(elem_conn) .or. .not. allocated(elem_nnode)) then
|
|
call error_set(FEM_ERR_INTERNAL, 'assembly requires allocated element connectivity', ierr)
|
|
return
|
|
end if
|
|
if (element_is_solid(elem_type(elem))) then
|
|
last_dof = 3
|
|
else if (element_is_shell(elem_type(elem))) then
|
|
last_dof = NDOF_NODE
|
|
else
|
|
call error_set(FEM_ERR_MESH, 'unsupported element type for assembly dofs', ierr)
|
|
return
|
|
end if
|
|
|
|
do local_node = 1, elem_nnode(elem)
|
|
node = elem_conn(local_node, elem)
|
|
if (node .lt. 1 .or. node .gt. nnode) then
|
|
call error_set(FEM_ERR_MESH, 'assembly element references invalid node', ierr)
|
|
return
|
|
end if
|
|
do dof_num = 1, last_dof
|
|
dof = dof_id(dof_num, node)
|
|
if (dof .gt. 0) then
|
|
if (n_elem_dof .ge. size(elem_dofs)) then
|
|
call error_set(FEM_ERR_INTERNAL, 'assembly element dof buffer is too small', ierr)
|
|
return
|
|
end if
|
|
n_elem_dof = n_elem_dof + 1
|
|
elem_dofs(n_elem_dof) = dof
|
|
end if
|
|
end do
|
|
end do
|
|
|
|
ierr = FEM_SUCCESS
|
|
end subroutine assembly_get_element_dofs
|
|
|
|
subroutine assembly_build_csr_pattern(kmat, ierr)
|
|
type(csr_matrix), intent(inout) :: kmat
|
|
integer, intent(out) :: ierr
|
|
integer, allocatable :: raw_count(:)
|
|
integer, allocatable :: row_count(:)
|
|
integer, allocatable :: row_cols(:,:)
|
|
integer, allocatable :: row_ptr(:)
|
|
integer, allocatable :: col_ind(:)
|
|
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
|
|
call error_set(FEM_ERR_SOLVER, 'CSR assembly requires positive ndof', ierr)
|
|
return
|
|
end if
|
|
if (.not. allocated(dof_id)) then
|
|
call error_set(FEM_ERR_INTERNAL, 'CSR assembly requires assigned dof_id table', ierr)
|
|
return
|
|
end if
|
|
|
|
allocate(raw_count(ndof), row_count(ndof), stat=stat)
|
|
if (stat .ne. 0) then
|
|
call error_set(FEM_ERR_SOLVER, 'failed to allocate CSR assembly row counts', ierr)
|
|
return
|
|
end if
|
|
raw_count = 1
|
|
row_count = 0
|
|
|
|
do elem = 1, nelem
|
|
if (allocated(elem_status)) then
|
|
if (elem_status(elem) .ne. 0) cycle
|
|
end if
|
|
|
|
call assembly_get_element_dofs(elem, elem_dofs, n_elem_dof, ierr)
|
|
if (ierr .ne. FEM_SUCCESS) go to 900
|
|
|
|
do i = 1, n_elem_dof
|
|
row = elem_dofs(i)
|
|
raw_count(row) = raw_count(row) + n_elem_dof
|
|
end do
|
|
end do
|
|
|
|
call count_mpc_pattern_entries(raw_count, ierr)
|
|
if (ierr .ne. FEM_SUCCESS) go to 900
|
|
call count_contact_pattern_entries(raw_count, ierr)
|
|
if (ierr .ne. FEM_SUCCESS) go to 900
|
|
|
|
max_raw = maxval(raw_count)
|
|
allocate(row_cols(max_raw, ndof), stat=stat)
|
|
if (stat .ne. 0) then
|
|
call error_set(FEM_ERR_SOLVER, 'failed to allocate CSR assembly row columns', ierr)
|
|
go to 900
|
|
end if
|
|
row_cols = 0
|
|
|
|
do row = 1, ndof
|
|
call append_unique_column(row_cols, row_count, max_raw, row, row, ierr)
|
|
if (ierr .ne. FEM_SUCCESS) go to 900
|
|
end do
|
|
|
|
do elem = 1, nelem
|
|
if (allocated(elem_status)) then
|
|
if (elem_status(elem) .ne. 0) cycle
|
|
end if
|
|
|
|
call assembly_get_element_dofs(elem, elem_dofs, n_elem_dof, ierr)
|
|
if (ierr .ne. FEM_SUCCESS) go to 900
|
|
|
|
do i = 1, n_elem_dof
|
|
row = elem_dofs(i)
|
|
do j = 1, n_elem_dof
|
|
col = elem_dofs(j)
|
|
call append_unique_column(row_cols, row_count, max_raw, row, col, ierr)
|
|
if (ierr .ne. FEM_SUCCESS) go to 900
|
|
end do
|
|
end do
|
|
end do
|
|
|
|
call append_mpc_pattern_columns(row_cols, row_count, max_raw, ierr)
|
|
if (ierr .ne. FEM_SUCCESS) go to 900
|
|
call append_contact_pattern_columns(row_cols, row_count, max_raw, ierr)
|
|
if (ierr .ne. FEM_SUCCESS) go to 900
|
|
|
|
do row = 1, ndof
|
|
call sort_row_columns(row_cols, row_count(row), row)
|
|
end do
|
|
|
|
allocate(row_ptr(ndof+1), stat=stat)
|
|
if (stat .ne. 0) then
|
|
call error_set(FEM_ERR_SOLVER, 'failed to allocate CSR row_ptr', ierr)
|
|
go to 900
|
|
end if
|
|
|
|
row_ptr(1) = 1
|
|
do row = 1, ndof
|
|
row_ptr(row+1) = row_ptr(row) + row_count(row)
|
|
end do
|
|
|
|
allocate(col_ind(row_ptr(ndof+1)-1), stat=stat)
|
|
if (stat .ne. 0) then
|
|
call error_set(FEM_ERR_SOLVER, 'failed to allocate CSR col_ind', ierr)
|
|
go to 900
|
|
end if
|
|
|
|
pos = 1
|
|
do row = 1, ndof
|
|
do i = 1, row_count(row)
|
|
col_ind(pos) = row_cols(i,row)
|
|
pos = pos + 1
|
|
end do
|
|
end do
|
|
|
|
call csr_create_pattern(kmat, ndof, ndof, row_ptr, col_ind, ierr)
|
|
|
|
900 continue
|
|
if (allocated(raw_count)) deallocate(raw_count)
|
|
if (allocated(row_count)) deallocate(row_count)
|
|
if (allocated(row_cols)) deallocate(row_cols)
|
|
if (allocated(row_ptr)) deallocate(row_ptr)
|
|
if (allocated(col_ind)) deallocate(col_ind)
|
|
end subroutine assembly_build_csr_pattern
|
|
|
|
subroutine assembly_add_element_matrix(kmat, elem_dofs, n_elem_dof, ke, ierr)
|
|
type(csr_matrix), intent(inout) :: kmat
|
|
integer, intent(in) :: elem_dofs(:)
|
|
integer, intent(in) :: n_elem_dof
|
|
real(rk), intent(in) :: ke(:,:)
|
|
integer, intent(out) :: ierr
|
|
integer :: i
|
|
integer :: j
|
|
|
|
if (n_elem_dof .le. 0) then
|
|
call error_set(FEM_ERR_SOLVER, 'element matrix assembly received no dofs', ierr)
|
|
return
|
|
end if
|
|
if (size(elem_dofs) .lt. n_elem_dof) then
|
|
call error_set(FEM_ERR_SOLVER, 'element matrix dof list is too small', ierr)
|
|
return
|
|
end if
|
|
if (size(ke,1) .lt. n_elem_dof .or. size(ke,2) .lt. n_elem_dof) then
|
|
call error_set(FEM_ERR_SOLVER, 'element matrix size is inconsistent with dofs', ierr)
|
|
return
|
|
end if
|
|
|
|
do i = 1, n_elem_dof
|
|
call validate_global_dof(elem_dofs(i), ierr)
|
|
if (ierr .ne. FEM_SUCCESS) return
|
|
do j = 1, n_elem_dof
|
|
call validate_global_dof(elem_dofs(j), ierr)
|
|
if (ierr .ne. FEM_SUCCESS) return
|
|
call csr_add_value(kmat, elem_dofs(i), elem_dofs(j), ke(i,j), ierr)
|
|
if (ierr .ne. FEM_SUCCESS) return
|
|
end do
|
|
end do
|
|
|
|
ierr = FEM_SUCCESS
|
|
end subroutine assembly_add_element_matrix
|
|
|
|
subroutine assembly_add_element_vector(rhs, elem_dofs, n_elem_dof, fe, ierr)
|
|
real(rk), intent(inout) :: rhs(:)
|
|
integer, intent(in) :: elem_dofs(:)
|
|
integer, intent(in) :: n_elem_dof
|
|
real(rk), intent(in) :: fe(:)
|
|
integer, intent(out) :: ierr
|
|
integer :: i
|
|
integer :: dof
|
|
|
|
if (n_elem_dof .le. 0) then
|
|
call error_set(FEM_ERR_SOLVER, 'element vector assembly received no dofs', ierr)
|
|
return
|
|
end if
|
|
if (size(elem_dofs) .lt. n_elem_dof .or. size(fe) .lt. n_elem_dof) then
|
|
call error_set(FEM_ERR_SOLVER, 'element vector size is inconsistent with dofs', ierr)
|
|
return
|
|
end if
|
|
if (size(rhs) .ne. ndof) then
|
|
call error_set(FEM_ERR_SOLVER, 'global RHS size is inconsistent with ndof', ierr)
|
|
return
|
|
end if
|
|
|
|
do i = 1, n_elem_dof
|
|
dof = elem_dofs(i)
|
|
call validate_global_dof(dof, ierr)
|
|
if (ierr .ne. FEM_SUCCESS) return
|
|
rhs(dof) = rhs(dof) + fe(i)
|
|
end do
|
|
|
|
ierr = FEM_SUCCESS
|
|
end subroutine assembly_add_element_vector
|
|
|
|
subroutine append_unique_column(row_cols, row_count, max_raw, row, col, ierr)
|
|
integer, intent(inout) :: row_cols(:,:)
|
|
integer, intent(inout) :: row_count(:)
|
|
integer, intent(in) :: max_raw
|
|
integer, intent(in) :: row
|
|
integer, intent(in) :: col
|
|
integer, intent(out) :: ierr
|
|
integer :: i
|
|
|
|
if (row .lt. 1 .or. row .gt. size(row_count)) then
|
|
call error_set(FEM_ERR_SOLVER, 'CSR assembly row is out of range', ierr)
|
|
return
|
|
end if
|
|
|
|
do i = 1, row_count(row)
|
|
if (row_cols(i,row) .eq. col) then
|
|
ierr = FEM_SUCCESS
|
|
return
|
|
end if
|
|
end do
|
|
|
|
if (row_count(row) .ge. max_raw) then
|
|
call error_set(FEM_ERR_SOLVER, 'CSR assembly row capacity exceeded', ierr)
|
|
return
|
|
end if
|
|
|
|
row_count(row) = row_count(row) + 1
|
|
row_cols(row_count(row),row) = col
|
|
ierr = FEM_SUCCESS
|
|
end subroutine append_unique_column
|
|
|
|
subroutine count_mpc_pattern_entries(raw_count, ierr)
|
|
integer, intent(inout) :: raw_count(:)
|
|
integer, intent(out) :: ierr
|
|
integer :: eqn
|
|
integer :: item
|
|
integer :: start_pos
|
|
integer :: stop_pos
|
|
integer :: dof
|
|
|
|
do eqn = 1, nmpc
|
|
start_pos = mpc_start(eqn)
|
|
stop_pos = start_pos + mpc_count(eqn) - 1
|
|
if (start_pos .lt. 1 .or. stop_pos .gt. nmpc_term) then
|
|
call error_set(FEM_ERR_SOLVER, 'MPC pattern term range is invalid', ierr)
|
|
return
|
|
end if
|
|
|
|
do item = start_pos, stop_pos
|
|
call mpc_term_dof(item, dof, ierr)
|
|
if (ierr .ne. FEM_SUCCESS) return
|
|
if (dof .gt. 0) raw_count(dof) = raw_count(dof) + mpc_count(eqn)
|
|
end do
|
|
end do
|
|
|
|
ierr = FEM_SUCCESS
|
|
end subroutine count_mpc_pattern_entries
|
|
|
|
subroutine append_mpc_pattern_columns(row_cols, row_count, max_raw, ierr)
|
|
integer, intent(inout) :: row_cols(:,:)
|
|
integer, intent(inout) :: row_count(:)
|
|
integer, intent(in) :: max_raw
|
|
integer, intent(out) :: ierr
|
|
integer :: eqn
|
|
integer :: row_item
|
|
integer :: col_item
|
|
integer :: start_pos
|
|
integer :: stop_pos
|
|
integer :: row
|
|
integer :: col
|
|
|
|
do eqn = 1, nmpc
|
|
start_pos = mpc_start(eqn)
|
|
stop_pos = start_pos + mpc_count(eqn) - 1
|
|
if (start_pos .lt. 1 .or. stop_pos .gt. nmpc_term) then
|
|
call error_set(FEM_ERR_SOLVER, 'MPC pattern term range is invalid', ierr)
|
|
return
|
|
end if
|
|
|
|
do row_item = start_pos, stop_pos
|
|
call mpc_term_dof(row_item, row, ierr)
|
|
if (ierr .ne. FEM_SUCCESS) return
|
|
if (row .le. 0) cycle
|
|
|
|
do col_item = start_pos, stop_pos
|
|
call mpc_term_dof(col_item, col, ierr)
|
|
if (ierr .ne. FEM_SUCCESS) return
|
|
if (col .gt. 0) then
|
|
call append_unique_column(row_cols, row_count, max_raw, row, col, ierr)
|
|
if (ierr .ne. FEM_SUCCESS) return
|
|
end if
|
|
end do
|
|
end do
|
|
end do
|
|
|
|
ierr = FEM_SUCCESS
|
|
end subroutine append_mpc_pattern_columns
|
|
|
|
subroutine count_contact_pattern_entries(raw_count, ierr)
|
|
integer, intent(inout) :: raw_count(:)
|
|
integer, intent(out) :: ierr
|
|
integer :: pair
|
|
integer :: slave_elem
|
|
integer :: master_elem
|
|
integer :: i
|
|
integer :: nslave
|
|
integer :: nmaster
|
|
integer :: slave_dofs(MAX_ELEM_DOF)
|
|
integer :: master_dofs(MAX_ELEM_DOF)
|
|
integer :: add_count
|
|
|
|
do pair = 1, ncontact_pair
|
|
do slave_elem = 1, nelem
|
|
if (.not. contact_target_matches_elem(slave_elem, &
|
|
contact_pair_slave(pair))) cycle
|
|
call assembly_get_element_dofs(slave_elem, slave_dofs, nslave, ierr)
|
|
if (ierr .ne. FEM_SUCCESS) return
|
|
|
|
do master_elem = 1, nelem
|
|
if (.not. contact_target_matches_elem(master_elem, &
|
|
contact_pair_master(pair))) cycle
|
|
call assembly_get_element_dofs(master_elem, master_dofs, nmaster, ierr)
|
|
if (ierr .ne. FEM_SUCCESS) return
|
|
|
|
add_count = nslave + nmaster
|
|
do i = 1, nslave
|
|
if (slave_dofs(i) .gt. 0) raw_count(slave_dofs(i)) = &
|
|
raw_count(slave_dofs(i)) + add_count
|
|
end do
|
|
do i = 1, nmaster
|
|
if (master_dofs(i) .gt. 0) raw_count(master_dofs(i)) = &
|
|
raw_count(master_dofs(i)) + add_count
|
|
end do
|
|
end do
|
|
end do
|
|
end do
|
|
|
|
ierr = FEM_SUCCESS
|
|
end subroutine count_contact_pattern_entries
|
|
|
|
subroutine append_contact_pattern_columns(row_cols, row_count, max_raw, ierr)
|
|
integer, intent(inout) :: row_cols(:,:)
|
|
integer, intent(inout) :: row_count(:)
|
|
integer, intent(in) :: max_raw
|
|
integer, intent(out) :: ierr
|
|
integer :: pair
|
|
integer :: slave_elem
|
|
integer :: master_elem
|
|
integer :: nslave
|
|
integer :: nmaster
|
|
integer :: slave_dofs(MAX_ELEM_DOF)
|
|
integer :: master_dofs(MAX_ELEM_DOF)
|
|
|
|
do pair = 1, ncontact_pair
|
|
do slave_elem = 1, nelem
|
|
if (.not. contact_target_matches_elem(slave_elem, &
|
|
contact_pair_slave(pair))) cycle
|
|
call assembly_get_element_dofs(slave_elem, slave_dofs, nslave, ierr)
|
|
if (ierr .ne. FEM_SUCCESS) return
|
|
|
|
do master_elem = 1, nelem
|
|
if (.not. contact_target_matches_elem(master_elem, &
|
|
contact_pair_master(pair))) cycle
|
|
call assembly_get_element_dofs(master_elem, master_dofs, nmaster, ierr)
|
|
if (ierr .ne. FEM_SUCCESS) return
|
|
|
|
call append_dof_block(row_cols, row_count, max_raw, &
|
|
slave_dofs, nslave, slave_dofs, nslave, ierr)
|
|
if (ierr .ne. FEM_SUCCESS) return
|
|
call append_dof_block(row_cols, row_count, max_raw, &
|
|
slave_dofs, nslave, master_dofs, nmaster, ierr)
|
|
if (ierr .ne. FEM_SUCCESS) return
|
|
call append_dof_block(row_cols, row_count, max_raw, &
|
|
master_dofs, nmaster, slave_dofs, nslave, ierr)
|
|
if (ierr .ne. FEM_SUCCESS) return
|
|
call append_dof_block(row_cols, row_count, max_raw, &
|
|
master_dofs, nmaster, master_dofs, nmaster, ierr)
|
|
if (ierr .ne. FEM_SUCCESS) return
|
|
end do
|
|
end do
|
|
end do
|
|
|
|
ierr = FEM_SUCCESS
|
|
end subroutine append_contact_pattern_columns
|
|
|
|
subroutine append_dof_block(row_cols, row_count, max_raw, rows, nrow, &
|
|
cols, ncol, ierr)
|
|
integer, intent(inout) :: row_cols(:,:)
|
|
integer, intent(inout) :: row_count(:)
|
|
integer, intent(in) :: max_raw
|
|
integer, intent(in) :: rows(:)
|
|
integer, intent(in) :: nrow
|
|
integer, intent(in) :: cols(:)
|
|
integer, intent(in) :: ncol
|
|
integer, intent(out) :: ierr
|
|
integer :: i
|
|
integer :: j
|
|
|
|
do i = 1, nrow
|
|
if (rows(i) .le. 0) cycle
|
|
do j = 1, ncol
|
|
if (cols(j) .gt. 0) then
|
|
call append_unique_column(row_cols, row_count, max_raw, &
|
|
rows(i), cols(j), ierr)
|
|
if (ierr .ne. FEM_SUCCESS) return
|
|
end if
|
|
end do
|
|
end do
|
|
|
|
ierr = FEM_SUCCESS
|
|
end subroutine append_dof_block
|
|
|
|
logical function contact_target_matches_elem(elem, target)
|
|
integer, intent(in) :: elem
|
|
character(len=*), intent(in) :: target
|
|
|
|
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)
|
|
integer, intent(in) :: item
|
|
integer, intent(out) :: dof
|
|
integer, intent(out) :: ierr
|
|
integer :: node
|
|
|
|
dof = 0
|
|
if (item .lt. 1 .or. item .gt. nmpc_term) then
|
|
call error_set(FEM_ERR_SOLVER, 'MPC term index is out of range', ierr)
|
|
return
|
|
end if
|
|
if (mpc_dof(item) .lt. 1 .or. mpc_dof(item) .gt. NDOF_NODE) then
|
|
call error_set(FEM_ERR_SOLVER, 'MPC term dof is outside 1..6', ierr)
|
|
return
|
|
end if
|
|
|
|
node = database_find_node(mpc_node(item))
|
|
if (node .eq. 0) then
|
|
call error_set(FEM_ERR_SOLVER, 'MPC term references unknown node', ierr)
|
|
return
|
|
end if
|
|
|
|
dof = dof_id(mpc_dof(item),node)
|
|
ierr = FEM_SUCCESS
|
|
end subroutine mpc_term_dof
|
|
|
|
subroutine sort_row_columns(row_cols, count, row)
|
|
integer, intent(inout) :: row_cols(:,:)
|
|
integer, intent(in) :: count
|
|
integer, intent(in) :: row
|
|
integer :: i
|
|
integer :: j
|
|
integer :: key
|
|
|
|
do i = 2, count
|
|
key = row_cols(i,row)
|
|
j = i - 1
|
|
do while (j .ge. 1)
|
|
if (row_cols(j,row) .le. key) exit
|
|
row_cols(j+1,row) = row_cols(j,row)
|
|
j = j - 1
|
|
end do
|
|
row_cols(j+1,row) = key
|
|
end do
|
|
end subroutine sort_row_columns
|
|
|
|
subroutine validate_global_dof(dof, ierr)
|
|
integer, intent(in) :: dof
|
|
integer, intent(out) :: ierr
|
|
|
|
if (dof .lt. 1 .or. dof .gt. ndof) then
|
|
call error_set(FEM_ERR_SOLVER, 'global dof is out of range during assembly', ierr)
|
|
return
|
|
end if
|
|
|
|
ierr = FEM_SUCCESS
|
|
end subroutine validate_global_dof
|
|
|
|
end module fem_assembly_csr
|