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
32

#include "../drivers/uart.h"
#include "../graphics/drawer.h"
#include "../sys/core.h"
#include "../sys/timer.h"
#include "../util/mutex.h"
#include "../util/status.h"
#include "../util/time.h"

/// Cycles Per Second
#define CPS 10

#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();
}