Subversion Repositories Code-Repo

#include "defines.h"
#include "TIMER4.h"

static TIMER4_DATA *timer_data_ptr;

void TIMER4_Init(TIMER4_DATA *data, void (*callback_ms)(void),
        void (*callback_div)(void), uint32_t time_ms) {
    
    if (data != NULL) // if ptr is null, use existing data
        timer_data_ptr = data;

    // The first callback function will be executed every ms
    timer_data_ptr->callback_function_1 = callback_ms;
    // The second callback function will be executed at the multiplier specified
    timer_data_ptr->callback_function_2 = callback_div;
    timer_data_ptr->divider = time_ms;
    timer_data_ptr->count = 0;

    INTDisableInterrupts();

    T4CON = 0x0;

    // Set timer to trigger every millisecond
    uint16_t time = 5000;
    T4CONSET = 0x0040;         // Prescaler at 1:16

    Nop();
    TMR4 = 0x0;             // Clear timer register
    PR4 = time;             // Load period register
    IPC4SET = 0x00000005;   // Set priority level = 1, sub-priority level = 1
    IFS0CLR = 0x00010000;   // Clear timer interrupt flag
    IEC0SET = 0x00010000;   // Enable timer interrupt

    INTEnableInterrupts();
}

void TIMER4_Start(void) {
    T4CONSET = 0x8000; // Start timer
}

void TIMER4_Stop(void) {
    T4CONCLR = 0x8000; // Stop timer
}

void __ISR(_TIMER_4_VECTOR, ipl4) __TIMER_4_Interrupt_Handler(void) {
    // Call the saved callback function
    (*timer_data_ptr->callback_function_1)();

    if (timer_data_ptr->divider != 0 && timer_data_ptr->callback_function_2 != NULL) {
        if (timer_data_ptr->count == timer_data_ptr->divider) {
            (*timer_data_ptr->callback_function_2)();
            timer_data_ptr->count = 0;
        } else {
            timer_data_ptr->count++;
        }
    }

    IFS0CLR = 0x00010000; // Clear the timer interrupt flag
}