differential-equations 0.6.0

//! Core matrix type, storage enum, and constructors.

use crate::{linalg::LinalgError, traits::Real};

fn coalesce_triplets<T: Real>(
    n: usize,
    m: usize,
    triplets: Vec<(usize, usize, T)>,
) -> Vec<(usize, usize, T)> {
    let mut coords: Vec<(usize, usize, T)> = Vec::new();
    for (row, col, val) in triplets {
        assert!(row < n && col < m, "Sparse triplet index out of bounds");
        if let Some(entry) = coords.iter_mut().find(|(r, c, _)| *r == row && *c == col) {
            entry.2 += val;
        } else {
            coords.push((row, col, val));
        }
    }
    coords.retain(|(_, _, v)| *v != T::zero());
    coords
}

/// Matrix storage layout.
#[derive(PartialEq, Clone, Debug)]
pub enum MatrixStorage<T: Real> {
    /// Identity matrix (implicit). `data` stores [one, zero] to satisfy indexing by reference.
    Identity,
    /// Dense row-major matrix (nrows*ncols entries).
    Full,
    /// Banded matrix with lower (ml) and upper (mu) bandwidth.
    /// Compact diagonal storage with shape (ml+mu+1, ncols), row-major per diagonal.
    /// Off-band reads return `zero`.
    Banded { ml: usize, mu: usize, zero: T },
    /// Sparse matrix representation using coordinate format.
    Sparse {
        coords: Vec<(usize, usize, T)>,
        zero: T,
    },
}

/// Generic matrix for linear algebra (typically square in current use).
#[derive(PartialEq, Clone, Debug)]
pub struct Matrix<T: Real> {
    pub n: usize,
    pub m: usize,
    pub data: Vec<T>,
    pub storage: MatrixStorage<T>,
}

impl<T: Real> Matrix<T> {
    /// Number of rows.
    pub fn nrows(&self) -> usize {
        self.n
    }

    /// Number of columns.
    pub fn ncols(&self) -> usize {
        self.m
    }

    /// Identity matrix of size n x n.
    pub fn identity(n: usize) -> Self {
        Matrix {
            n,
            m: n,
            // Keep [one, zero] so indexing can return references.
            data: vec![T::one(), T::zero()],
            storage: MatrixStorage::Identity,
        }
    }

    /// Creates a dense row-major matrix from a vector.
    ///
    /// # Errors
    /// Returns [`LinalgError::BadInput`] when `data.len() != n * m`.
    pub fn from_vec(n: usize, m: usize, data: Vec<T>) -> Result<Self, LinalgError> {
        if data.len() != n * m {
            return Err(LinalgError::BadInput {
                message: format!(
                    "Incompatible data length: expected {}, got {}",
                    n * m,
                    data.len()
                ),
            });
        }
        Ok(Matrix {
            n,
            m,
            data,
            storage: MatrixStorage::Full,
        })
    }

    /// Empty sparse matrix of size n x m.
    pub fn sparse(n: usize, m: usize) -> Self {
        Matrix {
            n,
            m,
            data: Vec::new(),
            storage: MatrixStorage::Sparse {
                coords: Vec::new(),
                zero: T::zero(),
            },
        }
    }

    /// Sparse matrix from coordinate triplets.
    ///
    /// Duplicate entries for the same (row, col) are coalesced (summed) at
    /// construction time, and any entries that sum to zero are dropped.
    /// This guarantees that no two stored coordinates share the same position,
    /// so `Index` / `IndexMut` work consistently without a separate `get`/`set`.
    pub fn sparse_from_triplets(n: usize, m: usize, triplets: Vec<(usize, usize, T)>) -> Self {
        let coords = coalesce_triplets(n, m, triplets);
        Matrix {
            n,
            m,
            data: Vec::new(),
            storage: MatrixStorage::Sparse {
                coords,
                zero: T::zero(),
            },
        }
    }

    /// Full matrix from a row-major vector of length n*m.
    pub fn full(n: usize, m: usize) -> Self {
        let data = vec![T::zero(); n * m];
        Matrix {
            n,
            m,
            data,
            storage: MatrixStorage::Full,
        }
    }

    /// Square matrix of size n x n.
    pub fn square(n: usize) -> Self {
        Matrix {
            n,
            m: n,
            data: Vec::with_capacity(n * n),
            storage: MatrixStorage::Full,
        }
    }

    /// Zero matrix of size n x m.
    pub fn zeros(n: usize, m: usize) -> Self {
        Matrix {
            n,
            m,
            data: vec![T::zero(); n * m],
            storage: MatrixStorage::Full,
        }
    }

    /// Zero banded matrix with the given bandwidths.
    /// For entry (i,j) within the band, index maps to data[i - j + mu, j].
    pub fn banded(n: usize, ml: usize, mu: usize) -> Self {
        let rows = ml + mu + 1;
        let data = vec![T::zero(); rows * n];
        Matrix {
            n,
            m: n,
            data,
            storage: MatrixStorage::Banded {
                ml,
                mu,
                zero: T::zero(),
            },
        }
    }

    /// Diagonal matrix from the provided diagonal entries (ml=mu=0).
    pub fn diagonal(diag: Vec<T>) -> Self {
        let n = diag.len();
        // With ml=mu=0, storage is (1,n), so `diag` maps directly to row 0.
        Matrix {
            n,
            m: n,
            data: diag,
            storage: MatrixStorage::Banded {
                ml: 0,
                mu: 0,
                zero: T::zero(),
            },
        }
    }

    /// Zero lower-triangular matrix (ml = n-1, mu = 0).
    pub fn lower_triangular(n: usize) -> Self {
        Matrix::banded(n, n.saturating_sub(1), 0)
    }

    /// Zero upper-triangular matrix (ml = 0, mu = n-1).
    pub fn upper_triangular(n: usize) -> Self {
        Matrix::banded(n, 0, n.saturating_sub(1))
    }

    /// Dimensions (nrows, ncols).
    pub fn dims(&self) -> (usize, usize) {
        (self.n, self.m)
    }

    /// Convert the matrix to dense row-major storage.
    pub fn to_dense_vec(&self) -> Vec<T> {
        match &self.storage {
            MatrixStorage::Full => self.data.clone(),
            MatrixStorage::Identity => {
                let mut dense = vec![T::zero(); self.n * self.m];
                for i in 0..self.n.min(self.m) {
                    dense[i * self.m + i] = T::one();
                }
                dense
            }
            MatrixStorage::Banded { ml, mu, .. } => {
                let mut dense = vec![T::zero(); self.n * self.m];
                for col in 0..self.m {
                    for band_row in 0..(*ml + *mu + 1) {
                        let offset = band_row as isize - *mu as isize;
                        let row_signed = col as isize + offset;
                        if row_signed >= 0 && (row_signed as usize) < self.n {
                            let row = row_signed as usize;
                            dense[row * self.m + col] += self.data[band_row * self.m + col];
                        }
                    }
                }
                dense
            }
            MatrixStorage::Sparse { coords, .. } => {
                let mut dense = vec![T::zero(); self.n * self.m];
                for &(row, col, value) in coords {
                    dense[row * self.m + col] += value;
                }
                dense
            }
        }
    }

    /// Convert the matrix to full storage in place.
    pub fn make_full(&mut self) {
        self.data = self.to_dense_vec();
        self.storage = MatrixStorage::Full;
    }

    /// Checks if the matrix is an identity matrix.
    pub fn is_identity(&self) -> bool {
        if let MatrixStorage::Identity = self.storage {
            return true;
        } else if let MatrixStorage::Full = self.storage {
            for i in 0..self.n {
                for j in 0..self.m {
                    let expected = if i == j { T::one() } else { T::zero() };
                    if self.data[i * self.m + j] != expected {
                        return false;
                    }
                }
            }
        } else if let MatrixStorage::Banded {
            ml: _ml,
            mu: _mu,
            zero,
        } = self.storage
        {
            for i in 0..self.n {
                for j in 0..self.m {
                    let expected = if i == j { T::one() } else { zero };
                    if self.data[i * self.m + j] != expected {
                        return false;
                    }
                }
            }
        } else if let MatrixStorage::Sparse { ref coords, .. } = self.storage {
            let diag_count = self.n.min(self.m);
            if coords.len() != diag_count {
                return false;
            }
            for &(r, c, v) in coords {
                if r != c || v != T::one() {
                    return false;
                }
            }
        }
        true
    }

    /// Swap two rows in-place for Full storage. For Banded storage, performs a logical swap
    /// of accessible entries within the band; for Identity, no-op unless swapping equal indices.
    pub fn swap_rows(&mut self, r1: usize, r2: usize) {
        assert!(r1 < self.n && r2 < self.n, "row index out of bounds");
        if r1 == r2 {
            return;
        }
        match &mut self.storage {
            MatrixStorage::Full => {
                for j in 0..self.m {
                    self.data.swap(r1 * self.m + j, r2 * self.m + j);
                }
            }
            MatrixStorage::Identity => {
                // Identity is stored as [one, zero]; swapping has no effect on implicit structure.
                // Clients should not attempt to permute Identity rows; we ignore to keep API simple.
            }
            MatrixStorage::Banded { ml, mu, .. } => {
                // Only swap entries that are actually stored (within band).
                // For each column j, if (r1,j) and/or (r2,j) are in band, swap.
                let mlv = *ml as isize;
                let muv = *mu as isize;
                for j in 0..self.m {
                    let k1 = r1 as isize - j as isize;
                    let k2 = r2 as isize - j as isize;
                    let in1 = k1 >= -muv && k1 <= mlv;
                    let in2 = k2 >= -muv && k2 <= mlv;
                    if in1 && in2 {
                        let row1 = (k1 + *mu as isize) as usize;
                        let row2 = (k2 + *mu as isize) as usize;
                        self.data.swap(row1 * self.m + j, row2 * self.m + j);
                    } else if in1 || in2 {
                        // One entry is implicit zero; swapping sets stored one to zero and vice versa
                        // This best-effort maintains logical swap within band footprint.
                        if in1 {
                            let row1 = (k1 + *mu as isize) as usize;
                            let idx1 = row1 * self.m + j;
                            self.data[idx1] = T::zero();
                        } else {
                            let row2 = (k2 + *mu as isize) as usize;
                            let idx2 = row2 * self.m + j;
                            self.data[idx2] = T::zero();
                        }
                    }
                }
            }
            MatrixStorage::Sparse { coords, .. } => {
                for item in coords.iter_mut() {
                    if item.0 == r1 {
                        item.0 = r2;
                    } else if item.0 == r2 {
                        item.0 = r1;
                    }
                }
            }
        }
    }

    /// Fill the matrix with a constant value.
    pub fn fill(&mut self, value: T) {
        match &mut self.storage {
            MatrixStorage::Identity
            | MatrixStorage::Banded { .. }
            | MatrixStorage::Sparse { .. }
                if value != T::zero() =>
            {
                self.data = vec![value; self.n * self.m];
                self.storage = MatrixStorage::Full;
            }
            MatrixStorage::Sparse { coords, zero } => {
                coords.clear();
                *zero = T::zero();
            }
            _ => self.data.fill(value),
        }
    }
}

#[cfg(test)]
mod tests {
    use super::{LinalgError, Matrix, MatrixStorage};

    #[test]
    fn diagonal_constructor_sets_diagonal() {
        let m = Matrix::diagonal(vec![1.0f64, 2.0, 3.0]);
        assert_eq!(m[(0, 0)], 1.0);
        assert_eq!(m[(1, 1)], 2.0);
        assert_eq!(m[(2, 2)], 3.0);
        assert_eq!(m[(0, 1)], 0.0);
        assert_eq!(m[(2, 0)], 0.0);
    }

    #[test]
    fn triangular_constructors_shape() {
        let l: Matrix<f64> = Matrix::lower_triangular(4);
        // Above main diagonal reads zero
        assert_eq!(l[(0, 3)], 0.0);
        let u: Matrix<f64> = Matrix::upper_triangular(4);
        // Below main diagonal reads zero
        assert_eq!(u[(3, 0)], 0.0);
    }

    #[test]
    fn from_vec_rejects_incompatible_data_length() {
        let result = Matrix::<f64>::from_vec(2, 3, vec![1.0, 2.0, 3.0, 4.0]);

        assert_eq!(
            result,
            Err(LinalgError::BadInput {
                message: "Incompatible data length: expected 6, got 4".to_string(),
            })
        );
    }

    #[test]
    fn sparse_triplets_coalesce_duplicates() {
        let m = Matrix::sparse_from_triplets(2, 3, vec![(0, 1, 2.0), (0, 1, 3.0), (1, 2, 4.0)]);
        assert_eq!(m[(0, 0)], 0.0);
        assert_eq!(m[(0, 1)], 5.0);
        assert_eq!(m[(1, 2)], 4.0);
        assert_eq!(m.to_dense_vec(), vec![0.0, 5.0, 0.0, 0.0, 0.0, 4.0]);
    }

    #[test]
    fn sparse_index_mut_replaces_coalesced_entry() {
        let mut m = Matrix::sparse_from_triplets(2, 2, vec![(0, 1, 2.0), (0, 1, 3.0), (1, 1, 4.0)]);
        m[(0, 1)] = 7.0;
        assert_eq!(m[(0, 1)], 7.0);
        m[(1, 0)] = 0.0;
        assert_eq!(m[(1, 0)], 0.0);
    }

    #[test]
    fn sparse_fill_zero_preserves_sparse_storage() {
        let mut m = Matrix::sparse_from_triplets(2, 2, vec![(0, 1, 2.0)]);
        m.fill(0.0);
        assert_eq!(m[(0, 1)], 0.0);
        assert!(matches!(m.storage, MatrixStorage::Sparse { .. }));
    }

    #[test]
    fn sparse_storage_carries_zero_reference() {
        let m = Matrix::<f64>::sparse(2, 2);
        match &m.storage {
            MatrixStorage::Sparse { zero, .. } => {
                assert_eq!(m[(1, 1)], *zero);
            }
            _ => panic!("expected sparse storage"),
        }
    }
}