d/freebsd-nq
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Recognize the Soekris NET5501 and configure the error led.

Browse Source 
Add watchdog(4) support by using the MFGPT0 in the Geode LX CX5536.
(Supported range: 2^30 .. 2^44 ns = 1s ... 5h)

Approved by:	re (bmah)
This commit is contained in:
Poul-Henning Kamp 2007-09-18 09:19:44 +00:00
parent 8f3ba4ccf4
commit f1be017900
1 changed files with 84 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

87
sys/i386/i386/geode.c
View File

@ -49,6 +49,16 @@ static struct bios_oem bios_soekris = {
}
};
static struct bios_oem bios_soekris_55 = {
{ 0xf0000, 0xf1000 },
{
{ "Soekris", 0, 8 }, /* Soekris Engineering. */
{ "net5", 0, 8 }, /* net5xxx */
{ "comBIOS", 0, 54 }, /* comBIOS ver. 1.26a 20040819 ... */
{ NULL, 0, 0 },
}
};
static struct bios_oem bios_pcengines = {
{ 0xf9000, 0xfa000 },
{
@ -94,6 +104,25 @@ led_func(void *ptr, int onoff)
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 (onoff)
outl(a, 1 << bit);
else
outl(a, 1 << (bit + 16));
}
static unsigned
geode_get_timecount(struct timecounter *tc)
@ -157,6 +186,43 @@ geode_watchdog(void *foo __unused, u_int cmd, int *error)
}
}
/*
* We run MFGPT0 off the 32kHz frequency and prescale by 16384 giving a
* period of half a second.
* Range becomes 2^30 (= 1 sec) to 2^44 (almost 5 hours)
*/
static void
cs5536_watchdog(void *foo __unused, u_int cmd, int *error)
{
u_int u, p;
uint16_t a;
uint32_t m;
a = rdmsr(0x5140000d);
m = rdmsr(0x51400029);
m &= ~(1 << 24);
wrmsr(0x51400029, m);
u = cmd & WD_INTERVAL;
if (u >= 30 && u <= 44) {
p = 1 << (u - 29);
/* Set up MFGPT0, 32khz, prescaler 16k, C2 event */
outw(a + 6, 0x030e);
/* set comparator 2 */
outw(a + 2, p);
/* reset counter */
outw(a + 4, 0);
/* Arm reset mechanism */
m |= (1 << 24);
wrmsr(0x51400029, m);
/* Start counter */
outw(a + 6, 0x8000);
*error = 0;
}
}
/*
* The Advantech PCM-582x watchdog expects 0x1 at I/O port 0x0443
* every 1.6 secs +/- 30%. Writing 0x0 disables the watchdog
@ -182,7 +248,8 @@ geode_probe(device_t self)
#define BIOS_OEM_MAXLEN 80
static u_char bios_oem[BIOS_OEM_MAXLEN] = "\0";
if (pci_get_devid(self) == 0x0515100b) {
switch (pci_get_devid(self)) {
case 0x0515100b:
if (geode_counter == 0) {
/*
* The address of the CBA is written to this register
@ -199,7 +266,8 @@ geode_probe(device_t self)
NULL, 0);
set_cputicker(geode_cputicks, 27000000, 0);
}
} else if (pci_get_devid(self) == 0x0510100b) {
break;
case 0x0510100b:
gpio = pci_read_config(self, PCIR_BAR(0), 4);
gpio &= ~0x1f;
printf("Geode GPIO@ = %x\n", gpio);
@ -223,13 +291,26 @@ geode_probe(device_t self)
}
if ( strlen(bios_oem) )
printf("Geode %s\n", bios_oem);
} else if (pci_get_devid(self) == 0x01011078) {
break;
case 0x01011078:
if ( bios_oem_strings(&bios_advantech,
bios_oem, BIOS_OEM_MAXLEN) > 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, BIOS_OEM_MAXLEN) > 0 ) {
printf("Geode LX: %s\n", bios_oem);
led1b = 6;
led1 = led_create(cs5536_led_func, &led1b, "error");
}
printf("MFGPT bar: %jx\n", rdmsr(0x5140000d));
EVENTHANDLER_REGISTER(watchdog_list, cs5536_watchdog,
NULL, 0);
break;
}
return (ENXIO);
}