Add CSR sparse matrix infrastructure
This commit is contained in:
@@ -0,0 +1,310 @@
|
||||
module fem_sparse_csr
|
||||
use fem_precision
|
||||
use fem_error
|
||||
implicit none
|
||||
|
||||
private
|
||||
|
||||
type csr_matrix
|
||||
integer :: nrow = 0
|
||||
integer :: ncol = 0
|
||||
integer :: nnz = 0
|
||||
integer, pointer :: row_ptr(:) => null()
|
||||
integer, pointer :: col_ind(:) => null()
|
||||
real(rk), pointer :: val(:) => null()
|
||||
end type csr_matrix
|
||||
|
||||
public :: csr_matrix
|
||||
public :: csr_init
|
||||
public :: csr_free
|
||||
public :: csr_create_pattern
|
||||
public :: csr_zero
|
||||
public :: csr_add_value
|
||||
public :: csr_set_value
|
||||
public :: csr_get_value
|
||||
public :: csr_matvec
|
||||
public :: csr_apply_dirichlet
|
||||
|
||||
contains
|
||||
|
||||
subroutine csr_init(a)
|
||||
type(csr_matrix), intent(inout) :: a
|
||||
|
||||
a%nrow = 0
|
||||
a%ncol = 0
|
||||
a%nnz = 0
|
||||
nullify(a%row_ptr)
|
||||
nullify(a%col_ind)
|
||||
nullify(a%val)
|
||||
end subroutine csr_init
|
||||
|
||||
subroutine csr_free(a, ierr)
|
||||
type(csr_matrix), intent(inout) :: a
|
||||
integer, intent(out) :: ierr
|
||||
|
||||
if (associated(a%row_ptr)) deallocate(a%row_ptr)
|
||||
if (associated(a%col_ind)) deallocate(a%col_ind)
|
||||
if (associated(a%val)) deallocate(a%val)
|
||||
call csr_init(a)
|
||||
ierr = FEM_SUCCESS
|
||||
end subroutine csr_free
|
||||
|
||||
subroutine csr_create_pattern(a, nrow, ncol, row_ptr_in, col_ind_in, ierr)
|
||||
type(csr_matrix), intent(inout) :: a
|
||||
integer, intent(in) :: nrow
|
||||
integer, intent(in) :: ncol
|
||||
integer, intent(in) :: row_ptr_in(:)
|
||||
integer, intent(in) :: col_ind_in(:)
|
||||
integer, intent(out) :: ierr
|
||||
integer :: i
|
||||
integer :: k
|
||||
integer :: stat
|
||||
integer :: nnz
|
||||
|
||||
if (nrow .le. 0 .or. ncol .le. 0) then
|
||||
call error_set(FEM_ERR_SOLVER, 'CSR matrix dimensions must be positive', ierr)
|
||||
return
|
||||
end if
|
||||
if (size(row_ptr_in) .ne. nrow + 1) then
|
||||
call error_set(FEM_ERR_SOLVER, 'CSR row_ptr size is inconsistent with nrow', ierr)
|
||||
return
|
||||
end if
|
||||
if (row_ptr_in(1) .ne. 1) then
|
||||
call error_set(FEM_ERR_SOLVER, 'CSR row_ptr must use 1-based indexing', ierr)
|
||||
return
|
||||
end if
|
||||
do i = 1, nrow
|
||||
if (row_ptr_in(i+1) .lt. row_ptr_in(i)) then
|
||||
call error_set(FEM_ERR_SOLVER, 'CSR row_ptr must be nondecreasing', ierr)
|
||||
return
|
||||
end if
|
||||
end do
|
||||
|
||||
nnz = row_ptr_in(nrow+1) - 1
|
||||
if (nnz .ne. size(col_ind_in)) then
|
||||
call error_set(FEM_ERR_SOLVER, 'CSR col_ind size is inconsistent with row_ptr', ierr)
|
||||
return
|
||||
end if
|
||||
if (nnz .le. 0) then
|
||||
call error_set(FEM_ERR_SOLVER, 'CSR matrix must contain at least one entry', ierr)
|
||||
return
|
||||
end if
|
||||
|
||||
do i = 1, nrow
|
||||
do k = row_ptr_in(i), row_ptr_in(i+1) - 1
|
||||
if (col_ind_in(k) .lt. 1 .or. col_ind_in(k) .gt. ncol) then
|
||||
call error_set(FEM_ERR_SOLVER, 'CSR column index is out of range', ierr)
|
||||
return
|
||||
end if
|
||||
if (k .gt. row_ptr_in(i)) then
|
||||
if (col_ind_in(k) .le. col_ind_in(k-1)) then
|
||||
call error_set(FEM_ERR_SOLVER, 'CSR column indices must be strictly increasing per row', ierr)
|
||||
return
|
||||
end if
|
||||
end if
|
||||
end do
|
||||
end do
|
||||
|
||||
call csr_free(a, ierr)
|
||||
if (ierr .ne. FEM_SUCCESS) return
|
||||
|
||||
allocate(a%row_ptr(nrow+1), a%col_ind(nnz), a%val(nnz), stat=stat)
|
||||
if (stat .ne. 0) then
|
||||
call error_set(FEM_ERR_SOLVER, 'failed to allocate CSR matrix', ierr)
|
||||
return
|
||||
end if
|
||||
|
||||
a%nrow = nrow
|
||||
a%ncol = ncol
|
||||
a%nnz = nnz
|
||||
a%row_ptr = row_ptr_in
|
||||
a%col_ind = col_ind_in
|
||||
a%val = ZERO
|
||||
ierr = FEM_SUCCESS
|
||||
end subroutine csr_create_pattern
|
||||
|
||||
subroutine csr_zero(a, ierr)
|
||||
type(csr_matrix), intent(inout) :: a
|
||||
integer, intent(out) :: ierr
|
||||
|
||||
if (.not. csr_is_allocated(a)) then
|
||||
call error_set(FEM_ERR_SOLVER, 'CSR matrix is not allocated', ierr)
|
||||
return
|
||||
end if
|
||||
a%val = ZERO
|
||||
ierr = FEM_SUCCESS
|
||||
end subroutine csr_zero
|
||||
|
||||
subroutine csr_add_value(a, row, col, value, ierr)
|
||||
type(csr_matrix), intent(inout) :: a
|
||||
integer, intent(in) :: row
|
||||
integer, intent(in) :: col
|
||||
real(rk), intent(in) :: value
|
||||
integer, intent(out) :: ierr
|
||||
integer :: k
|
||||
|
||||
call csr_find_position(a, row, col, k, ierr)
|
||||
if (ierr .ne. FEM_SUCCESS) return
|
||||
a%val(k) = a%val(k) + value
|
||||
ierr = FEM_SUCCESS
|
||||
end subroutine csr_add_value
|
||||
|
||||
subroutine csr_set_value(a, row, col, value, ierr)
|
||||
type(csr_matrix), intent(inout) :: a
|
||||
integer, intent(in) :: row
|
||||
integer, intent(in) :: col
|
||||
real(rk), intent(in) :: value
|
||||
integer, intent(out) :: ierr
|
||||
integer :: k
|
||||
|
||||
call csr_find_position(a, row, col, k, ierr)
|
||||
if (ierr .ne. FEM_SUCCESS) return
|
||||
a%val(k) = value
|
||||
ierr = FEM_SUCCESS
|
||||
end subroutine csr_set_value
|
||||
|
||||
subroutine csr_get_value(a, row, col, value, ierr)
|
||||
type(csr_matrix), intent(in) :: a
|
||||
integer, intent(in) :: row
|
||||
integer, intent(in) :: col
|
||||
real(rk), intent(out) :: value
|
||||
integer, intent(out) :: ierr
|
||||
integer :: k
|
||||
|
||||
if (.not. csr_is_allocated(a)) then
|
||||
call error_set(FEM_ERR_SOLVER, 'CSR matrix is not allocated', ierr)
|
||||
return
|
||||
end if
|
||||
if (row .lt. 1 .or. row .gt. a%nrow .or. col .lt. 1 .or. col .gt. a%ncol) then
|
||||
call error_set(FEM_ERR_SOLVER, 'CSR query index is out of range', ierr)
|
||||
return
|
||||
end if
|
||||
|
||||
value = ZERO
|
||||
do k = a%row_ptr(row), a%row_ptr(row+1) - 1
|
||||
if (a%col_ind(k) .eq. col) then
|
||||
value = a%val(k)
|
||||
exit
|
||||
end if
|
||||
end do
|
||||
ierr = FEM_SUCCESS
|
||||
end subroutine csr_get_value
|
||||
|
||||
subroutine csr_matvec(a, x, y, ierr)
|
||||
type(csr_matrix), intent(in) :: a
|
||||
real(rk), intent(in) :: x(:)
|
||||
real(rk), intent(out) :: y(:)
|
||||
integer, intent(out) :: ierr
|
||||
integer :: i
|
||||
integer :: k
|
||||
|
||||
if (.not. csr_is_allocated(a)) then
|
||||
call error_set(FEM_ERR_SOLVER, 'CSR matrix is not allocated', ierr)
|
||||
return
|
||||
end if
|
||||
if (size(x) .ne. a%ncol .or. size(y) .ne. a%nrow) then
|
||||
call error_set(FEM_ERR_SOLVER, 'CSR matvec vector size mismatch', ierr)
|
||||
return
|
||||
end if
|
||||
|
||||
y = ZERO
|
||||
do i = 1, a%nrow
|
||||
do k = a%row_ptr(i), a%row_ptr(i+1) - 1
|
||||
y(i) = y(i) + a%val(k) * x(a%col_ind(k))
|
||||
end do
|
||||
end do
|
||||
ierr = FEM_SUCCESS
|
||||
end subroutine csr_matvec
|
||||
|
||||
subroutine csr_apply_dirichlet(a, rhs, dof, value, ierr)
|
||||
type(csr_matrix), intent(inout) :: a
|
||||
real(rk), intent(inout) :: rhs(:)
|
||||
integer, intent(in) :: dof
|
||||
real(rk), intent(in) :: value
|
||||
integer, intent(out) :: ierr
|
||||
integer :: i
|
||||
integer :: k
|
||||
integer :: diag_pos
|
||||
|
||||
if (.not. csr_is_allocated(a)) then
|
||||
call error_set(FEM_ERR_SOLVER, 'CSR matrix is not allocated', ierr)
|
||||
return
|
||||
end if
|
||||
if (a%nrow .ne. a%ncol) then
|
||||
call error_set(FEM_ERR_SOLVER, 'Dirichlet application requires a square CSR matrix', ierr)
|
||||
return
|
||||
end if
|
||||
if (size(rhs) .ne. a%nrow) then
|
||||
call error_set(FEM_ERR_SOLVER, 'Dirichlet RHS size mismatch', ierr)
|
||||
return
|
||||
end if
|
||||
if (dof .lt. 1 .or. dof .gt. a%nrow) then
|
||||
call error_set(FEM_ERR_SOLVER, 'Dirichlet DOF is out of range', ierr)
|
||||
return
|
||||
end if
|
||||
|
||||
diag_pos = 0
|
||||
do k = a%row_ptr(dof), a%row_ptr(dof+1) - 1
|
||||
if (a%col_ind(k) .eq. dof) diag_pos = k
|
||||
end do
|
||||
if (diag_pos .eq. 0) then
|
||||
call error_set(FEM_ERR_SOLVER, 'Dirichlet DOF has no diagonal entry in CSR pattern', ierr)
|
||||
return
|
||||
end if
|
||||
|
||||
do i = 1, a%nrow
|
||||
if (i .ne. dof) then
|
||||
do k = a%row_ptr(i), a%row_ptr(i+1) - 1
|
||||
if (a%col_ind(k) .eq. dof) then
|
||||
rhs(i) = rhs(i) - a%val(k) * value
|
||||
a%val(k) = ZERO
|
||||
end if
|
||||
end do
|
||||
end if
|
||||
end do
|
||||
|
||||
do k = a%row_ptr(dof), a%row_ptr(dof+1) - 1
|
||||
a%val(k) = ZERO
|
||||
end do
|
||||
a%val(diag_pos) = ONE
|
||||
rhs(dof) = value
|
||||
ierr = FEM_SUCCESS
|
||||
end subroutine csr_apply_dirichlet
|
||||
|
||||
logical function csr_is_allocated(a)
|
||||
type(csr_matrix), intent(in) :: a
|
||||
|
||||
csr_is_allocated = associated(a%row_ptr) .and. associated(a%col_ind) .and. &
|
||||
associated(a%val)
|
||||
end function csr_is_allocated
|
||||
|
||||
subroutine csr_find_position(a, row, col, pos, ierr)
|
||||
type(csr_matrix), intent(in) :: a
|
||||
integer, intent(in) :: row
|
||||
integer, intent(in) :: col
|
||||
integer, intent(out) :: pos
|
||||
integer, intent(out) :: ierr
|
||||
integer :: k
|
||||
|
||||
pos = 0
|
||||
if (.not. csr_is_allocated(a)) then
|
||||
call error_set(FEM_ERR_SOLVER, 'CSR matrix is not allocated', ierr)
|
||||
return
|
||||
end if
|
||||
if (row .lt. 1 .or. row .gt. a%nrow .or. col .lt. 1 .or. col .gt. a%ncol) then
|
||||
call error_set(FEM_ERR_SOLVER, 'CSR insertion index is out of range', ierr)
|
||||
return
|
||||
end if
|
||||
|
||||
do k = a%row_ptr(row), a%row_ptr(row+1) - 1
|
||||
if (a%col_ind(k) .eq. col) then
|
||||
pos = k
|
||||
ierr = FEM_SUCCESS
|
||||
return
|
||||
end if
|
||||
end do
|
||||
|
||||
call error_set(FEM_ERR_SOLVER, 'CSR entry is not present in matrix pattern', ierr)
|
||||
end subroutine csr_find_position
|
||||
|
||||
end module fem_sparse_csr
|
||||
Reference in New Issue
Block a user