/*
* Timer interrupt handler.
* Should be called (and return) with interrupts disabled.
*/
void
linux_timer_intr()
{
unsigned long mask;
struct timer_struct *tp;
osenv_assert(osenv_intr_enabled() == 0);
for (mask = 1, tp = timer_table; mask; tp++, mask += mask) {
if (mask > timer_active)
break;
if (!(mask & timer_active))
continue;
if (tp->expires > jiffies)
continue;
mark_bh(TIMER_BH);
}
if (timer_head.next->expires <= jiffies)
mark_bh(TIMER_BH);
if (tq_timer)
mark_bh(TQUEUE_BH);
/* If any linux software handlers pending, schedule a softirq */
if (bh_mask & bh_active)
osenv_softirq_schedule(softintr_vector);
osenv_assert(osenv_intr_enabled() == 0);
}
/*
* Timer software interrupt handler.
* Should be called (and return) with interrupts enabled.
*/
void
timer_bh()
{
unsigned long mask;
struct timer_struct *tp;
struct timer_list * timer;
osenv_assert(osenv_intr_enabled() != 0);
linux_cli();
while ((timer = timer_head.next) != &timer_head
&& timer->expires <= jiffies) {
void (*fn)(unsigned long) = timer->function;
unsigned long data = timer->data;
timer->next->prev = timer->prev;
timer->prev->next = timer->next;
timer->next = timer->prev = NULL;
linux_sti();
fn(data);
linux_cli();
}
linux_sti();
for (mask = 1, tp = timer_table; mask; tp++, mask <<= 1) {
if (mask > timer_active)
break;
if ((mask & timer_active)
&& tp->expires > jiffies) {
timer_active &= ~mask;
(*tp->fn)();
linux_sti();
}
}
osenv_assert(osenv_intr_enabled() != 0);
}
unsigned
linux_save_flags()
{
unsigned rc;
asm volatile("
pushfl
popl %0" : "=r" (rc));
rc &= ~IF_FLAG;
if (osenv_intr_enabled())
rc |= IF_FLAG;
return rc;
}
int
osenv_sleep(osenv_sleeprec_t *sr)
{
volatile osenv_sleeprec_t *vsr = sr;
int was_enabled = osenv_intr_enabled();
printf("inside osenv_sleep\n");
osenv_assert(sr);
/* We won't get anywhere if interrupts aren't enabled! */
osenv_intr_enable();
/* Busy-wait until osenv_wakeup() clears the flag in the sleeprec */
while (vsr->data[1])
/* NOTHING */;
/* Restore the original interrupt enable state */
if (!was_enabled)
osenv_intr_disable();
return (int) vsr->data[0];
}
