#include "discrete.h"

namespace bdm {

void rectangular_support::set_parameters ( const Array<vec> &ranges0, const ivec &gridsize0 ) {
    ranges = ranges0;
    gridsizes = gridsize0;
    initialize();
}


void rectangular_support::initialize() {
    dim = ranges.length();
    bdm_assert ( gridsizes.length() == dim, "Incompatible dimensions of input" );
    Npoints = prod ( gridsizes );
    bdm_assert ( Npoints > 0, "Wrong input parameters" );

    //precompute steps
    steps.set_size ( dim );
    for ( int j = 0; j < dim; j++ ) {
        steps ( j ) = ( ranges ( j ) ( 1 ) - ranges ( j ) ( 0 ) ) / gridsizes ( j );
    }
    actvec.set_size ( dim );
    actvec_ind.set_size ( dim );
}

vec rectangular_support::get_vec ( const ivec &inds ) {
    vec v ( dim );
    for ( int j = 0; j < dim; j++ ) {
        bdm_assert_debug ( inds ( j ) < gridsizes ( j ), "Index out of bounds" );
        v ( j ) = ranges ( j ) ( 0 ) + ( 0.5 + inds ( j ) ) * steps ( j );
    }
    return v;
}

long rectangular_support::linear_index ( const ivec inds ) {
    long ind = 0;
    bdm_assert_debug ( inds.length() == dim, "Improper indices inds" );
    int dim_skips = 1; // skips in active dimension, in the first dimension, the skips are 1 index per value

    for ( int j = 0; j < dim; j++ ) {
        ind += dim_skips * ( inds ( j ) ); // add shift in linear index caused by this dimension
        dim_skips *= gridsizes ( j );  // indices in the next dimension are repeated with period gridsizes(j) times greater that in this dimesion
    }
    return ind;
}
const vec& rectangular_support::first_vec() {
    for ( int j = 0; j < dim; j++ ) {
        actvec ( j ) = ranges ( j ) ( 0 ) + 0.5 * steps ( j );
        actvec_ind ( j ) = 0;
    }
    return actvec;
}
const vec& rectangular_support::next_vec() {
    // go through all dimensions
    int j = 0;
    while ( j < dim ) {
        if ( actvec_ind ( j ) == gridsizes ( j ) - 1 ) { //j-th index is full
            actvec_ind ( j ) = 0; //shift back
            actvec ( j ) = ranges ( j ) ( 0 ) + 0.5 * steps ( j );
            j++;
        } else {
            actvec_ind ( j ) ++;
            actvec ( j ) += steps ( j );
            break;
        }
    }
    return actvec;
}


ivec rectangular_support::nearest_point ( const vec &val ) {
    ivec inds;
    inds.set_size ( dim );
    for ( int j = 0; j < dim; j++ ) {
        if ( val ( j ) < ranges ( j ) ( 0 ) )
            inds ( j ) = 0;
        else {
            if ( val ( j ) > ranges ( j ) ( 1 ) )
                //! \todo GRIDSIZES prejmenovat..
                inds ( j ) = gridsizes ( j ) - 1;
            else {
                inds ( j ) = (int) ::round ( val ( j ) - ranges ( j ) ( 0 ) / steps ( j ) );
            }
        }
    }
    return inds;
}

void rectangular_support::from_setting ( const Setting &set ) {
    UI::get ( ranges , set, "ranges", UI::compulsory );
    UI::get ( gridsizes, set, "gridsizes", UI::compulsory );
    initialize();
}



void discrete_support::from_setting ( const Setting &set ) {
    UI::get ( Spoints, set, "points", UI::optional );
    if ( points() < 1 ) {
        int npoints;
        shared_ptr<epdf> ep = UI::build<epdf> ( set, "epdf", UI::compulsory );
        if ( !UI::get ( npoints, set, "npoints", UI::optional ) ) {
            npoints = 100;
        }

        //sample
        Spoints.set_size ( npoints );
        for ( int i = 0; i < points(); i++ ) {
            Spoints ( i ) = ep->sample();
        }
    }
}

void grid_fnc::set_values ( double ( *evalptr ) ( const vec& ) ) {
    if ( sup.points() > 0 ) {
        values ( 0 ) = ( *evalptr ) ( sup.first_vec() );
        for ( int j = 1; j < sup.points(); j++ ) {
            values ( j ) = ( *evalptr ) ( sup.next_vec() );
        }
    }
}

void grid_fnc::set_values ( const epdf &ep ) {
    if ( sup.points() > 0 ) {
        values ( 0 ) =  exp ( ep.evallog ( sup.first_vec() ) );
        for ( int j = 1; j < sup.points(); j++ ) {
            values ( j ) = exp ( ep.evallog ( sup.next_vec() ) );
        }
    }
}

}