#include <mach/mach_types.h>
#include <kern/timer_queue.h>
#include <kern/clock.h>
#include <kern/thread.h>
#include <kern/processor.h>
#include <kern/macro_help.h>
#include <kern/spl.h>
#include <kern/etimer.h>
#include <kern/pms.h>
#include <machine/commpage.h>
#include <machine/machine_routines.h>
#include <sys/kdebug.h>
#include <i386/cpu_data.h>
#include <i386/cpu_topology.h>
#include <i386/cpu_threads.h>
void
etimer_intr(int user_mode,
uint64_t rip)
{
uint64_t abstime;
rtclock_timer_t *mytimer;
cpu_data_t *pp;
int32_t latency;
uint64_t pmdeadline;
pp = current_cpu_datap();
abstime = mach_absolute_time();
mytimer = &pp->rtclock_timer;
if (mytimer->deadline <= abstime) {
latency = (int32_t) (abstime - mytimer->deadline);
KERNEL_DEBUG_CONSTANT(
MACHDBG_CODE(DBG_MACH_EXCP_DECI, 0) | DBG_FUNC_NONE,
-latency,
(uint32_t)rip, user_mode, 0, 0);
mytimer->has_expired = TRUE;
mytimer->deadline = timer_queue_expire(&mytimer->queue, abstime);
mytimer->has_expired = FALSE;
abstime = mach_absolute_time();
}
if ((pmdeadline = pmCPUGetDeadline(pp)) && (pmdeadline <= abstime)) {
KERNEL_DEBUG_CONSTANT(
MACHDBG_CODE(DBG_MACH_EXCP_DECI, 3) | DBG_FUNC_START,
0, 0, 0, 0, 0);
pmCPUDeadline(pp);
KERNEL_DEBUG_CONSTANT(
MACHDBG_CODE(DBG_MACH_EXCP_DECI, 3) | DBG_FUNC_END,
0, 0, 0, 0, 0);
}
etimer_resync_deadlines();
}
void etimer_set_deadline(uint64_t deadline)
{
rtclock_timer_t *mytimer;
spl_t s;
cpu_data_t *pp;
s = splclock();
pp = current_cpu_datap();
mytimer = &pp->rtclock_timer;
mytimer->deadline = deadline;
etimer_resync_deadlines();
splx(s);
}
void
etimer_resync_deadlines(void)
{
uint64_t deadline;
uint64_t pmdeadline;
rtclock_timer_t *mytimer;
spl_t s = splclock();
cpu_data_t *pp;
uint32_t decr;
pp = current_cpu_datap();
deadline = EndOfAllTime;
mytimer = &pp->rtclock_timer;
if (!mytimer->has_expired &&
0 < mytimer->deadline && mytimer->deadline < EndOfAllTime)
deadline = mytimer->deadline;
pmdeadline = pmCPUGetDeadline(pp);
if (0 < pmdeadline && pmdeadline < deadline)
deadline = pmdeadline;
decr = (uint32_t) setPop(deadline);
if (deadline != pmdeadline) {
KERNEL_DEBUG_CONSTANT(
MACHDBG_CODE(DBG_MACH_EXCP_DECI, 1) | DBG_FUNC_NONE,
decr, 2,
deadline, (uint32_t)(deadline >> 32), 0);
}
splx(s);
}
void etimer_timer_expire(void *arg);
void
etimer_timer_expire(
__unused void *arg)
{
rtclock_timer_t *mytimer;
uint64_t abstime;
cpu_data_t *pp;
pp = current_cpu_datap();
mytimer = &pp->rtclock_timer;
abstime = mach_absolute_time();
mytimer->has_expired = TRUE;
mytimer->deadline = timer_queue_expire(&mytimer->queue, abstime);
mytimer->has_expired = FALSE;
etimer_resync_deadlines();
}
queue_t
timer_queue_assign(
uint64_t deadline)
{
cpu_data_t *cdp = current_cpu_datap();
rtclock_timer_t *timer;
if (cdp->cpu_running) {
timer = &cdp->rtclock_timer;
if (deadline < timer->deadline)
etimer_set_deadline(deadline);
}
else
timer = &cpu_datap(master_cpu)->rtclock_timer;
return (&timer->queue);
}
void
timer_queue_cancel(
queue_t queue,
uint64_t deadline,
uint64_t new_deadline)
{
if (queue == ¤t_cpu_datap()->rtclock_timer.queue) {
if (deadline < new_deadline)
etimer_set_deadline(new_deadline);
}
}