/* PM watchdog timer management. 
 */

#include "pm.h"

#define VERBOSE 0

#include <timers.h>
#include <minix/syslib.h>
#include <minix/com.h>

PRIVATE timer_t *pm_timers = NULL;

PUBLIC void pm_set_timer(timer_t *tp, int ticks, tmr_func_t watchdog, int arg)
{
	int r;
	clock_t now, old_head = 0, new_head;

	if((r = getuptime(&now)) != OK)
		panic(__FILE__, "PM couldn't get uptime from system task.", NO_NUM);

	tmr_inittimer(tp);
	tmr_arg(tp)->ta_int = arg;

	old_head = tmrs_settimer(&pm_timers, tp, now+ticks, watchdog, &new_head);

	/* reschedule our synchronous alarm if necessary */
	if(! old_head || old_head > new_head) {
		if(sys_syncalrm(SELF, new_head, 1) != OK)
			panic(__FILE__, "PM set timer couldn't set synchronous alarm.", NO_NUM);
#if VERBOSE
		else
			printf("timers: after setting, set synalarm to %d -> %d\n", old_head, new_head);
#endif
	}

	return;
}

PUBLIC void pm_expire_timers(clock_t now)
{
	clock_t new_head;
	tmrs_exptimers(&pm_timers, now, &new_head);
	if(new_head > 0) {
		if(sys_syncalrm(SELF, new_head, 1) != OK)
			panic(__FILE__, "PM expire timer couldn't set synchronous alarm.", NO_NUM);
#if VERBOSE
		else
			printf("timers: after expiry, set synalarm to %d\n", new_head);
#endif
	}
#if VERBOSE
	else printf("after expiry, no new timer set\n");
#endif
}

PUBLIC void pm_cancel_timer(timer_t *tp)
{
	clock_t new_head, old_head;
	old_head = tmrs_clrtimer(&pm_timers, tp, &new_head);

	/* if the earliest timer has been removed, we have to set
	 * the synalarm to the next timer, or cancel the synalarm
	 * altogether if th last time has been cancelled (new_head
	 * will be 0 then).
	 */
	if(old_head < new_head || ! new_head) {
		if(sys_syncalrm(SELF, new_head, 1) != OK)
			panic(__FILE__, "PM expire timer couldn't set synchronous alarm.", NO_NUM);
#if VERBOSE
		printf("timers: after cancelling, set synalarm to %d -> %d\n", old_head, new_head);
#endif
	}
#if VERBOSE
	else printf("timers: after cancelling no new timer\n");
#endif
}