/////////////////////////////////////////////////////////////////////////////////////
//  file   : coproc.c
//  date   : avril 2015
//  author : Alain Greiner
/////////////////////////////////////////////////////////////////////////////////////
//  This file describes the single thread "coproc" application.
//  It uses the GCD (Greater Common Divider) hardware coprocessor
//  to make the GCD computation between two vectors of 32 bits integers.
//  It supports two coprocessor operating modes: MODE_DMA_IRQ or MODE_DMA_NO_IRQ. 
//  The vectors size is defined by the VECTOR_SIZE parameter.
/////////////////////////////////////////////////////////////////////////////////////


#include "stdio.h"
#include "mapping_info.h"       // for coprocessors types an modes

#define  VECTOR_SIZE 128   

#define  DMA_MODE    MODE_DMA_IRQ

#define  VERBOSE     1

// Memory buffers for coprocessor
unsigned int opa[VECTOR_SIZE] __attribute__((aligned(64)));
unsigned int opb[VECTOR_SIZE] __attribute__((aligned(64)));
unsigned int res[VECTOR_SIZE] __attribute__((aligned(64)));

/////////////////////////////////////////
__attribute__ ((constructor)) void main()
{
    // get processor identifiers
    unsigned int    x;
    unsigned int    y;
    unsigned int    lpid;
    giet_proc_xyp( &x, &y, &lpid );

    // get a private TTY terminal
    giet_tty_alloc( 0 );

    giet_tty_printf("\n*** Starting coproc application on processor"
                    "[%d,%d,%d] at cycle %d\n", 
                    x, y, lpid, giet_proctime() );

    // check coprocessor operating mode
    giet_pthread_assert( (DMA_MODE == MODE_DMA_IRQ) || (DMA_MODE == MODE_DMA_NO_IRQ),
    "\n[COPROC ERROR] only MODE_DMA_IRQ and MODE_DMA_NO_IRQ modes are supported");

    // initializes opa & opb buffers
    unsigned int word;
    for ( word = 0 ; word < VECTOR_SIZE ; word++ )
    {
        opa[word] = giet_rand() + 1;
        opb[word] = giet_rand() + 1;
    }

    unsigned int coproc_info;
    unsigned int cluster_xy  = (x << 4) + y;
    unsigned int coproc_type = MWR_SUBTYPE_GCD;

    // get a GCD coprocessor in local cluster
    giet_coproc_alloc( cluster_xy,
                       coproc_type,
                       &coproc_info );

    // check coprocessor ports
    unsigned int nb_to_coproc   = (coproc_info    ) & 0xFF;
    unsigned int nb_from_coproc = (coproc_info>> 8) & 0xFF;
    unsigned int nb_config      = (coproc_info>>16) & 0xFF;
    unsigned int nb_status      = (coproc_info>>24) & 0xFF;
    giet_pthread_assert( ((nb_to_coproc   == 2) &&
                         (nb_from_coproc == 1) &&
                         (nb_config      == 1) &&
                         (nb_status      == 0) ) ,
                         "wrong GCD coprocessor interface" );

#if  VERBOSE
giet_tty_printf("\n*** get GCD coprocessor at cycle %d\n", giet_proctime() );
#endif

    // initializes OPA channel
    giet_coproc_channel_t opa_desc;
    opa_desc.channel_mode = DMA_MODE;
    opa_desc.buffer_size  = VECTOR_SIZE<<2;
    opa_desc.buffer_vaddr = (unsigned int)opa;
    giet_coproc_channel_init( cluster_xy,
                              coproc_type,
                              0, 
                              &opa_desc );
    
    // initializes OPB channel
    giet_coproc_channel_t opb_desc;
    opb_desc.channel_mode = DMA_MODE;
    opb_desc.buffer_size  = VECTOR_SIZE<<2;
    opb_desc.buffer_vaddr = (unsigned int)opb;
    giet_coproc_channel_init( cluster_xy,
                              coproc_type,
                              1, 
                              &opb_desc );
    
    // initializes RES channel
    giet_coproc_channel_t res_desc;
    res_desc.channel_mode = DMA_MODE;
    res_desc.buffer_size  = VECTOR_SIZE<<2;
    res_desc.buffer_vaddr = (unsigned int)res;
    giet_coproc_channel_init( cluster_xy,
                              coproc_type,
                              2, 
                              &res_desc );
    
#if  VERBOSE
giet_tty_printf("\n*** channels initialized at cycle %d\n", giet_proctime() );
#endif

    // starts coprocessor
    giet_coproc_run( cluster_xy,
                     coproc_type );

#if  VERBOSE
giet_tty_printf("\n*** start GCD coprocessor at cycle %d\n", giet_proctime() );
#endif

    // wait coprocessor completion
    if ( DMA_MODE == MODE_DMA_NO_IRQ )
    {
        giet_coproc_completed( cluster_xy,
                               coproc_type );
    }

#if  VERBOSE
giet_tty_printf("\n*** GCD computation completed at cycle %d\n", giet_proctime() );
#endif

    // display result
    for ( word = 0 ; word < VECTOR_SIZE ; word++ )
    {
        giet_tty_printf("pgcd( %d , %d ) = %d\n",
        opa[word] , opb[word] , res[word] );
    }

    // release GCD coprocessor
    giet_coproc_release( cluster_xy,
                         coproc_type );

    giet_pthread_exit("completed");

} // end main