#include <sys/cdefs.h>
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/timetc.h>
#include <sys/kernel.h>
#include <sys/module.h>
#include <sys/sysctl.h>
#include <sys/bus.h>
#include <dev/pci/pcireg.h>
#include <dev/pci/pcivar.h>
static unsigned piix_get_timecount(struct timecounter *tc);
static u_int32_t piix_timecounter_address;
static u_int piix_freq = 14318182/4;
static struct timecounter piix_timecounter = {
piix_get_timecount,
0,
0xffffff,
0,
"PIIX"
};
static int
sysctl_machdep_piix_freq(SYSCTL_HANDLER_ARGS)
{
int error;
u_int freq;
if (piix_timecounter.tc_frequency == 0)
return (EOPNOTSUPP);
freq = piix_freq;
error = sysctl_handle_int(oidp, &freq, 0, req);
if (error == 0 && req->newptr != NULL) {
piix_freq = freq;
piix_timecounter.tc_frequency = piix_freq;
}
return (error);
}
SYSCTL_PROC(_machdep, OID_AUTO, piix_freq,
CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_NEEDGIANT, 0, sizeof(u_int),
sysctl_machdep_piix_freq, "I",
"");
static unsigned
piix_get_timecount(struct timecounter *tc)
{
unsigned u1, u2, u3;
u2 = inl(piix_timecounter_address);
u3 = inl(piix_timecounter_address);
do {
u1 = u2;
u2 = u3;
u3 = inl(piix_timecounter_address);
} while (u1 > u2 || u2 > u3);
return (u2);
}
static int
piix_probe(device_t dev)
{
u_int32_t d;
if (devclass_get_device(devclass_find("acpi"), 0) != NULL)
return (ENXIO);
switch (pci_get_devid(dev)) {
case 0x71138086:
device_set_desc(dev, "PIIX Timecounter");
break;
default:
return (ENXIO);
}
d = pci_read_config(dev, PCIR_COMMAND, 2);
if (!(d & PCIM_CMD_PORTEN)) {
device_printf(dev, "PIIX I/O space not mapped\n");
return (ENXIO);
}
return (0);
}
static int
piix_attach(device_t dev)
{
u_int32_t d;
d = pci_read_config(dev, 0x40, 4);
piix_timecounter_address = (d & 0xffc0) + 8;
piix_timecounter.tc_frequency = piix_freq;
tc_init(&piix_timecounter);
return (0);
}
static device_method_t piix_methods[] = {
DEVMETHOD(device_probe, piix_probe),
DEVMETHOD(device_attach, piix_attach),
{ 0, 0 }
};
static driver_t piix_driver = {
"piix",
piix_methods,
1,
};
DRIVER_MODULE(piix, pci, piix_driver, 0, 0);