/* matrix/init_source.c
 * 
 * Copyright (C) 1996, 1997, 1998, 1999, 2000 Gerard Jungman, Brian Gough
 * 
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or (at
 * your option) any later version.
 * 
 * This program is distributed in the hope that it will be useful, but
 * WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * General Public License for more details.
 * 
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
 */

TYPE(gsl_matrix) *
FUNCTION(gsl_matrix, alloc) (const size_t n1, const size_t n2)
{
    TYPE(gsl_block) * block;
    TYPE(gsl_matrix) * m;

    if (n1 == 0) {
	GSL_ERROR_VAL("matrix dimension n1 must be positive integer",
		      GSL_EINVAL, 0);
    } else if (n2 == 0) {
	GSL_ERROR_VAL("matrix dimension n2 must be positive integer",
		      GSL_EINVAL, 0);
    }

    m = (TYPE(gsl_matrix) *) malloc(sizeof(TYPE(gsl_matrix)));

    if (m == 0) {
	GSL_ERROR_VAL("failed to allocate space for matrix struct",
		      GSL_ENOMEM, 0);
    }

    /* FIXME: n1*n2 could overflow for large dimensions */

    block = FUNCTION(gsl_block, alloc) (n1 * n2);

    if (block == 0) {
	GSL_ERROR_VAL("failed to allocate space for block", GSL_ENOMEM, 0);
    }

    m->data = block->data;
    m->size1 = n1;
    m->size2 = n2;
    m->tda = n2;
    m->block = block;
    m->owner = 1;

    return m;
}


void FUNCTION(gsl_matrix, free) (TYPE(gsl_matrix) * m) {
    if (m->owner) {
	FUNCTION(gsl_block, free) (m->block);
    }

    free(m);
}

void FUNCTION(gsl_matrix, set_identity) (TYPE(gsl_matrix) * m) {
    size_t i, j;
    ATOMIC *const data = m->data;
    const size_t p = m->size1;
    const size_t q = m->size2;
    const size_t tda = m->tda;

    const BASE zero = ZERO;
    const BASE one = ONE;

    for (i = 0; i < p; i++) {
	for (j = 0; j < q; j++) {
	    *(BASE *) (data + MULTIPLICITY * (i * tda + j)) =
		((i == j) ? one : zero);
	}
    }
}