Added dumping the timer configuration, and the possibility to use any of

the hpet timer, not just the first 3.


git-svn-id: file:///srv/svn/repos/haiku/haiku/trunk@33285 a95241bf-73f2-0310-859d-f6bbb57e9c96
This commit is contained in:
Stefano Ceccherini 2009-09-25 05:08:22 +00:00
parent c82b73bd02
commit d54e62b2c8
2 changed files with 38 additions and 16 deletions

View File

@ -76,9 +76,7 @@ struct hpet_regs {
volatile uint64 reserved4;
volatile struct hpet_timer timer0;
volatile struct hpet_timer timer1;
volatile struct hpet_timer timer2;
volatile struct hpet_timer timer[1];
};

View File

@ -15,7 +15,7 @@
#include "hpet.h"
//#define TRACE_HPET
#define TRACE_HPET
#ifdef TRACE_HPET
#define TRACE(x) dprintf x
#else
@ -65,19 +65,19 @@ hpet_set_hardware_timer(bigtime_t relativeTimeout)
timerValue += sHPETRegs->counter;
//dprintf("setting value %d, cur is %d\n", timerValue, sHPETRegs->counter);
sHPETRegs->timer2.comparator = timerValue;
sHPETRegs->timer[2].comparator = timerValue;
// Clear the interrupt (set to 0)
//dprintf("clearing interrupts\n");
sHPETRegs->timer2.config &= (~31 << 9);
sHPETRegs->timer[2].config &= (~31 << 9);
// Non-periodic mode, edge triggered
//dprintf("edge mode\n");
sHPETRegs->timer2.config &= ~(0x8 & 0x2);
sHPETRegs->timer[2].config &= ~(0x8 & 0x2);
// Enable timer
//dprintf("enable\n");
sHPETRegs->timer2.config |= 0x4;
sHPETRegs->timer[2].config |= 0x4;
//dprintf("reenable interrupts\n");
restore_interrupts(state);
@ -90,7 +90,7 @@ static status_t
hpet_clear_hardware_timer(void)
{
// Disable timer
sHPETRegs->timer2.config &= ~0x4;
sHPETRegs->timer[2].config &= ~0x4;
return B_OK;
}
@ -120,10 +120,24 @@ hpet_set_legacy(struct hpet_regs *regs, bool enabled)
}
static void
dump_timer(volatile struct hpet_timer *timer)
{
dprintf("config: 0x%lx\n", timer->config);
dprintf("interrupts: 0x%lx\n", timer->interrupts);
dprintf("fsb_value: 0x%lx\n", timer->fsb_value);
dprintf("fsb_addr: 0x%lx\n", timer->fsb_addr);
}
static status_t
hpet_init(struct kernel_args *args)
{
/* hpet_acpi_probe() through a similar "scan spots" table to that of smp.cpp.
int c;
uint32 numTimers = 0;
/* hpet_acpi_probe() through a similar "scan spots" table
to that of smp.cpp.
Seems to be the most elegant solution right now. */
if (args->arch_args.hpet == NULL) {
@ -141,7 +155,8 @@ hpet_init(struct kernel_args *args)
}
}
TRACE(("hpet_init: HPET is at %p. Vendor ID: %lx.\n", sHPETRegs, HPET_GET_VENDOR_ID(sHPETRegs)));
TRACE(("hpet_init: HPET is at %p. Vendor ID: %lx.\n", sHPETRegs,
HPET_GET_VENDOR_ID(sHPETRegs)));
/* There is no hpet legacy support, so error out on init */
if (!HPET_IS_LEGACY_CAPABLE(sHPETRegs)) {
@ -150,16 +165,25 @@ hpet_init(struct kernel_args *args)
}
hpet_set_legacy(sHPETRegs, true);
TRACE(("hpet_init: HPET does%s support legacy mode.\n", HPET_IS_LEGACY_CAPABLE(sHPETRegs) ? "" : " not"));
TRACE(("hpet_init: HPET supports %lu timers, and is %s bits wide.\n", HPET_GET_NUM_TIMERS(sHPETRegs) + 1, HPET_IS_64BIT(sHPETRegs) ? "64" : "32"));
numTimers = HPET_GET_NUM_TIMERS(sHPETRegs) + 1;
TRACE(("hpet_init: HPET does%s support legacy mode.\n",
HPET_IS_LEGACY_CAPABLE(sHPETRegs) ? "" : " not"));
TRACE(("hpet_init: HPET supports %lu timers, and is %s bits wide.\n",
numTimers, HPET_IS_64BIT(sHPETRegs) ? "64" : "32"));
if (HPET_GET_NUM_TIMERS(sHPETRegs) < 2) {
if (numTimers < 3) {
dprintf("hpet_init: HPET does not have at least 3 timers. Skipping.\n");
return B_ERROR;
}
install_io_interrupt_handler(0xfb - ARCH_INTERRUPT_BASE, &hpet_timer_interrupt, NULL, B_NO_LOCK_VECTOR);
install_io_interrupt_handler(0, &hpet_timer_interrupt, NULL, B_NO_LOCK_VECTOR);
for (c = 0; c < numTimers; c++)
dump_timer(&sHPETRegs->timer[c]);
install_io_interrupt_handler(0xfb - ARCH_INTERRUPT_BASE,
&hpet_timer_interrupt, NULL, B_NO_LOCK_VECTOR);
install_io_interrupt_handler(0, &hpet_timer_interrupt, NULL,
B_NO_LOCK_VECTOR);
hpet_set_enabled(sHPETRegs, true);
return B_OK;