Add CSR assembly infrastructure

This commit is contained in:
shenw
2026-06-22 21:36:25 +08:00
parent 5375112eaf
commit 594af0784f
3 changed files with 497 additions and 0 deletions
+319
View File
@@ -0,0 +1,319 @@
module fem_assembly_csr
use fem_precision
use fem_error
use fem_database
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 :: 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
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, NDOF_NODE
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
integer :: i
integer :: j
integer :: pos
integer :: row
integer :: col
integer :: stat
integer :: max_raw
integer :: 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
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
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 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