HelenOS sources
This source file includes following definitions.
- interrupts_disable
- interrupts_enable
- interrupts_restore
- interrupts_read
- interrupts_disabled
- timer_suspend
- timer_start
- timer_claim
- timer_irq_handler
- interrupt_init
#include <arch/interrupt.h>
#include <arch/machine_func.h>
#include <ddi/irq.h>
#include <interrupt.h>
#include <time/clock.h>
static irq_t timer_irq;
static uint64_t timer_increment;
ipl_t interrupts_disable(void)
{
uint64_t daif = DAIF_read();
DAIF_write(daif | DAIF_IRQ_FLAG);
return daif & DAIF_IRQ_FLAG;
}
ipl_t interrupts_enable(void)
{
uint64_t daif = DAIF_read();
DAIF_write(daif & ~DAIF_IRQ_FLAG);
return daif & DAIF_IRQ_FLAG;
}
void interrupts_restore(ipl_t ipl)
{
uint64_t daif = DAIF_read();
DAIF_write((daif & ~DAIF_IRQ_FLAG) | (ipl & DAIF_IRQ_FLAG));
}
ipl_t interrupts_read(void)
{
return DAIF_read() & DAIF_IRQ_FLAG;
}
bool interrupts_disabled(void)
{
return DAIF_read() & DAIF_IRQ_FLAG;
}
static void timer_suspend(void)
{
uint64_t cntv_ctl = CNTV_CTL_EL0_read();
CNTV_CTL_EL0_write(cntv_ctl | CNTV_CTL_IMASK_FLAG);
}
static void timer_start(void)
{
uint64_t cntfrq = CNTFRQ_EL0_read();
uint64_t cntvct = CNTVCT_EL0_read();
uint64_t cntv_ctl = CNTV_CTL_EL0_read();
timer_increment = cntfrq / HZ;
CNTV_CVAL_EL0_write(cntvct + timer_increment);
CNTV_CTL_EL0_write(
(cntv_ctl & ~CNTV_CTL_IMASK_FLAG) | CNTV_CTL_ENABLE_FLAG);
}
static irq_ownership_t timer_claim(irq_t *irq)
{
return IRQ_ACCEPT;
}
static void timer_irq_handler(irq_t *irq)
{
uint64_t cntvct = CNTVCT_EL0_read();
uint64_t cntv_cval = CNTV_CVAL_EL0_read();
uint64_t drift = cntvct - cntv_cval;
while (drift > timer_increment) {
drift -= timer_increment;
CPU_LOCAL->missed_clock_ticks++;
}
CNTV_CVAL_EL0_write(cntvct + timer_increment - drift);
irq_spinlock_unlock(&irq->lock, false);
clock();
irq_spinlock_lock(&irq->lock, false);
}
void interrupt_init(void)
{
size_t irq_count = machine_get_irq_count();
irq_init(irq_count, irq_count);
timer_suspend();
inr_t timer_inr = machine_enable_vtimer_irq();
irq_initialize(&timer_irq);
timer_irq.inr = timer_inr;
timer_irq.claim = timer_claim;
timer_irq.handler = timer_irq_handler;
irq_register(&timer_irq);
timer_start();
}
HelenOS homepage, sources at GitHub