#include <stdio.h>

#include "grspw.h"
#include "fsw_params.h"

#define DSU_TIME_TAG_COUNTER 0x90000008

//**********
// IRQ LINES
#define IRQ_GRSPW 11
#define IRQ_SPARC_GRSPW 0x1b     // see sparcv8.pdf p.76 for interrupt levels

extern void *catch_interrupt(void func(), int irq);
int *lreg = (int *) 0x80000000;

#define ICLEAR 0x20c
#define IMASK  0x240
#define IFORCE 0x208

void enable_irq (int irq)
{
    lreg[ICLEAR/4] = (1 << irq);	// clear any pending irq
    lreg[IMASK/4] |= (1 << irq);	// unmaks irq
}

void disable_irq (int irq) { lreg[IMASK/4] &= ~(1 << irq); }	// mask irq

void force_irq (int irq) { lreg[IFORCE/4] = (1 << irq); }	// force irq

/* NOTE: NEVER put printf() or other stdio routines in interrupt handlers,
   they are not re-entrant. This (bad) example is just a demo */

volatile unsigned char processTimecode = 0;
unsigned int counter = 0;

void irqhandler(int irq)
{
    processTimecode = 1;
    counter ++;
}

int main( void )
{
    unsigned int *grspwCtrlReg;
    unsigned int k;
    volatile unsigned int *reg;
    float aux;

    printf("hello world!\n");

    grspwCtrlReg = (unsigned int*) REGS_ADDR_GRSPW;
    grspw_set_ie( 1, grspwCtrlReg );
    grspw_set_tq( 1, grspwCtrlReg );
    grspw_set_tr( 1, grspwCtrlReg );

    catch_interrupt(irqhandler, IRQ_GRSPW);
    enable_irq( IRQ_GRSPW );
    force_irq( IRQ_GRSPW );

    reg = (volatile unsigned int *) DSU_TIME_TAG_COUNTER;

    while(1)
    {
        if (processTimecode == 1)
        {
            printf("timecode counter = %d\n", counter);
            processTimecode = 0;
        }
    }

    return 0;
}