src/sys/timer.c


1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31

#include <drivers/uart.h>
#include <graphics/drawer.h>
#include <sys/core.h>
#include <sys/kernel.h>
#include <sys/timer.h>
#include <util/mutex.h>
#include <util/status.h>
#include <util/time.h>
#include <symbols.h>

#define SYS_TIMER_C
static unsigned long exe_cnt = 0;
struct Mutex exe_cnt_m = {.addr = &exe_cnt, .pid = NULL_PID};

void increase_counter(void)
{
	if (lock_mutex(&exe_cnt_m, SCHED_PID) == 0) {
		unsigned long* counter = (unsigned long*)exe_cnt_m.addr;
		*counter += 1;
		release_mutex(&exe_cnt_m, SCHED_PID);
	}
}

void c_timer(void)
{
	// Reset the counter
	write_cntv_tval(cntfrq/CPS);

	increase_counter();
	status();
}