| 0,0 → 1,60 |
|---|
| #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 |
| if (timer_data_ptr->callback_function_1 != NULL) |
| (*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 |
| } |