Subversion Repositories hf-risc

#include <hf-risc.h>

volatile int32_t ccount=0, ccount2=0, cmpcount=0, cmp2count=0;

/*

ISRs - interrupt service routines

*/

void counter_handler(void){                                             // 10.48ms @ 25MHz

        uint32_t m;

        ccount++;

        m = IRQ_MASK;                                                           // read interrupt mask

        m ^= (IRQ_COUNTER | IRQ_COUNTER_NOT);                           // toggle timer interrupt mask

        IRQ_MASK = m;                                                           // write to irq mask register

}

void counter_handler2(void){                                            // 2.62ms @ 25MHz

        uint32_t m;

        ccount2++;

        m = IRQ_MASK;                                                           // read interrupt mask

        m ^= (IRQ_COUNTER2 | IRQ_COUNTER2_NOT);                         // toggle timer interrupt mask

        IRQ_MASK = m;                                                           // write to irq mask register

}

void compare_handler(void){

        uint32_t val;

        cmpcount++;

        val = COUNTER;

        val += (CPU_SPEED/1000) * 5;            // 5 ms @ 25MHz

        COMPARE = val;                                          // update compare reg, clear irq

}

void compare2_handler(void){

        uint32_t val;

        cmp2count++;

        val = COUNTER;

        val += (CPU_SPEED/1000) * 1;            // 1 ms @ 25MHz

        COMPARE2 = val;                                         // update compare2 reg, clear irq

}

int main(void){

        // register ISRs

        interrupt_register(IRQ_COUNTER, counter_handler);

        interrupt_register(IRQ_COUNTER_NOT, counter_handler);

        interrupt_register(IRQ_COUNTER2, counter_handler2);

        interrupt_register(IRQ_COUNTER2_NOT, counter_handler2);

        interrupt_register(IRQ_COMPARE, compare_handler);

        interrupt_register(IRQ_COMPARE2, compare2_handler);

        // initialize compare registers, clear compare irqs

        COMPARE = COUNTER + (CPU_SPEED/1000) * 5;

        COMPARE2 = COUNTER + (CPU_SPEED/1000) * 1;

        // set interrupt mask (unmask peripheral interrupts)

        IRQ_MASK = (IRQ_COUNTER | IRQ_COUNTER2 | IRQ_COMPARE | IRQ_COMPARE2);

        // global interrupts enable

        IRQ_STATUS = 1;

        ccount=0; ccount2=0; cmpcount=0; cmp2count=0;

        for(;;){

                printf("\ninterrupts -> counter18: %d counter16: %d compare: %d compare2: %d", ccount, ccount2, cmpcount, cmp2count);

        }

}