#include <sys/param.h>
#include <sys/systm.h>
#include <sys/timetc.h>
#include <sys/bus.h>
#include <sys/eventhandler.h>
#include <sys/kernel.h>
#include <sys/module.h>
#include <sys/watchdog.h>
#include <dev/pci/pcireg.h>
#include <dev/pci/pcivar.h>
#include <dev/led/led.h>
#include <machine/pc/bios.h>
static struct bios_oem bios_soekris = {
{ 0xf0000, 0xf1000 },
{
{ "Soekris", 0, 8 },
{ "net4", 0, 8 },
{ "comBIOS", 0, 54 },
{ NULL, 0, 0 },
}
};
static struct bios_oem bios_soekris_55 = {
{ 0xf0000, 0xf1000 },
{
{ "Soekris", 0, 8 },
{ "net5", 0, 8 },
{ "comBIOS", 0, 54 },
{ NULL, 0, 0 },
}
};
static struct bios_oem bios_pcengines = {
{ 0xf9000, 0xfa000 },
{
{ "PC Engines WRAP", 0, 28 },
{ "tinyBIOS", 0, 28 },
{ NULL, 0, 0 },
}
};
static struct bios_oem bios_pcengines_55 = {
{ 0xf9000, 0xfa000 },
{
{ "PC Engines ALIX", 0, 28 },
{ "tinyBIOS", 0, 28 },
{ NULL, 0, 0 },
}
};
static struct bios_oem bios_advantech = {
{ 0xfe000, 0xff000 },
{
{ "**** PCM-582", 5, 33 },
{ "GXm-Cx5530", -11, 35 },
{ NULL, 0, 0 },
}
};
static unsigned cba;
static unsigned gpio;
static unsigned geode_counter;
static struct cdev *led1, *led2, *led3;
static int led1b, led2b, led3b;
static void
led_func(void *ptr, int onoff)
{
uint32_t u;
int bit;
bit = *(int *)ptr;
if (bit < 0) {
bit = -bit;
onoff = !onoff;
}
u = inl(gpio + 4);
if (onoff)
u |= 1 << bit;
else
u &= ~(1 << bit);
outl(gpio, u);
}
static void
cs5536_led_func(void *ptr, int onoff)
{
int bit;
uint16_t a;
bit = *(int *)ptr;
if (bit < 0) {
bit = -bit;
onoff = !onoff;
}
a = rdmsr(0x5140000c);
if (bit >= 16) {
a += 0x80;
bit -= 16;
}
if (onoff)
outl(a, 1 << bit);
else
outl(a, 1 << (bit + 16));
}
static unsigned
geode_get_timecount(struct timecounter *tc)
{
return (inl(geode_counter));
}
static struct timecounter geode_timecounter = {
geode_get_timecount,
NULL,
0xffffffff,
27000000,
"Geode",
1000
};
static uint64_t
geode_cputicks(void)
{
unsigned c;
static unsigned last;
static uint64_t offset;
c = inl(geode_counter);
if (c < last)
offset += (1LL << 32);
last = c;
return (offset | c);
}
static void
geode_watchdog(void *foo __unused, u_int cmd, int *error)
{
u_int u, p, r;
u = cmd & WD_INTERVAL;
if (u >= 14 && u <= 43) {
u -= 14;
if (u > 16) {
p = u - 16;
u -= p;
} else {
p = 0;
}
if (u == 16)
u = (1 << u) - 1;
else
u = 1 << u;
r = inw(cba + 2) & 0xff00;
outw(cba + 2, p | 0xf0 | r);
outw(cba, u);
*error = 0;
} else {
outw(cba, 0);
}
}
static void
cs5536_watchdog(void *foo __unused, u_int cmd, int *error)
{
u_int u, p, s;
uint16_t a;
uint32_t m;
a = rdmsr(0x5140000d);
u = cmd & WD_INTERVAL;
if (u >= 30 && u <= 44) {
p = 1 << (u - 29);
outw(a + 6, 0x030e);
outw(a + 2, p);
outw(a + 4, 0);
m = rdmsr(0x51400029);
m |= (1 << 24);
wrmsr(0x51400029, m);
outw(a + 6, 0x8000);
*error = 0;
} else {
s = inw(a + 6);
if (s & (1 << 12)) {
outw(a + 6, 0);
outw(a + 4, 0);
}
}
}
static void
advantech_watchdog(void *foo __unused, u_int cmd, int *error)
{
u_int u;
u = cmd & WD_INTERVAL;
if (u > 0 && u <= WD_TO_1SEC) {
outb(0x0443, 1);
*error = 0;
} else {
outb(0x0443, 0);
}
}
static int
geode_probe(device_t self)
{
#define BIOS_OEM_MAXLEN 80
static u_char bios_oem[BIOS_OEM_MAXLEN] = "\0";
switch (pci_get_devid(self)) {
case 0x0515100b:
if (geode_counter == 0) {
cba = pci_read_config(self, 0x64, 4);
if (bootverbose)
printf("Geode CBA@ 0x%x\n", cba);
geode_counter = cba + 0x08;
outl(cba + 0x0d, 2);
if (bootverbose)
printf("Geode rev: %02x %02x\n",
inb(cba + 0x3c), inb(cba + 0x3d));
tc_init(&geode_timecounter);
EVENTHANDLER_REGISTER(watchdog_list, geode_watchdog,
NULL, 0);
set_cputicker(geode_cputicks, 27000000, false);
}
break;
case 0x0510100b:
gpio = pci_read_config(self, PCIR_BAR(0), 4);
gpio &= ~0x1f;
if (bootverbose)
printf("Geode GPIO@ = %x\n", gpio);
if (bios_oem_strings(&bios_soekris,
bios_oem, sizeof bios_oem) > 0 ) {
led1b = 20;
led1 = led_create(led_func, &led1b, "error");
} else if (bios_oem_strings(&bios_pcengines,
bios_oem, sizeof bios_oem) > 0 ) {
led1b = -2;
led2b = -3;
led3b = -18;
led1 = led_create(led_func, &led1b, "led1");
led2 = led_create(led_func, &led2b, "led2");
led3 = led_create(led_func, &led3b, "led3");
led_func(&led1b, 1);
}
if (*bios_oem)
printf("Geode %s\n", bios_oem);
break;
case 0x01011078:
if (bios_oem_strings(&bios_advantech,
bios_oem, sizeof bios_oem) > 0 ) {
printf("Geode %s\n", bios_oem);
EVENTHANDLER_REGISTER(watchdog_list, advantech_watchdog,
NULL, 0);
}
break;
case 0x20801022:
if (bios_oem_strings(&bios_soekris_55,
bios_oem, sizeof bios_oem) > 0 ) {
led1b = 6;
led1 = led_create(cs5536_led_func, &led1b, "error");
} else if (bios_oem_strings(&bios_pcengines_55,
bios_oem, sizeof bios_oem) > 0 ) {
led1b = -6;
led2b = -25;
led3b = -27;
led1 = led_create(cs5536_led_func, &led1b, "led1");
led2 = led_create(cs5536_led_func, &led2b, "led2");
led3 = led_create(cs5536_led_func, &led3b, "led3");
cs5536_led_func(&led1b, 1);
}
if (*bios_oem)
printf("Geode LX: %s\n", bios_oem);
if (bootverbose)
printf("MFGPT bar: %jx\n", rdmsr(0x5140000d));
EVENTHANDLER_REGISTER(watchdog_list, cs5536_watchdog, NULL, 0);
break;
}
return (ENXIO);
}
static int
geode_attach(device_t self)
{
return(ENODEV);
}
static device_method_t geode_methods[] = {
DEVMETHOD(device_probe, geode_probe),
DEVMETHOD(device_attach, geode_attach),
DEVMETHOD(device_suspend, bus_generic_suspend),
DEVMETHOD(device_resume, bus_generic_resume),
DEVMETHOD(device_shutdown, bus_generic_shutdown),
{0, 0}
};
static driver_t geode_driver = {
"geode",
geode_methods,
0,
};
DRIVER_MODULE(geode, pci, geode_driver, 0, 0);