aboutsummaryrefslogtreecommitdiffstats
diff options
context:
space:
mode:
authorhpa <hpa>2005-01-05 00:07:01 +0000
committerhpa <hpa>2005-01-05 00:07:01 +0000
commit3c6c76e2b357bca40860878a6d10679bf9f3e329 (patch)
tree591ad0119d20a209dd5df6511507ac4d4fb5ee23
parent5de270feba04b7b9d0ea24789b67224b2060733e (diff)
downloadsyslinux-elf-3c6c76e2b357bca40860878a6d10679bf9f3e329.tar.gz
syslinux-elf-3c6c76e2b357bca40860878a6d10679bf9f3e329.tar.xz
syslinux-elf-3c6c76e2b357bca40860878a6d10679bf9f3e329.zip
New module "ethersel" which scans for devices and boots an appropriate
one derived from the configuration file.
-rw-r--r--com32/modules/Makefile2
-rw-r--r--com32/modules/ethersel.c256
2 files changed, 257 insertions, 1 deletions
diff --git a/com32/modules/Makefile b/com32/modules/Makefile
index 23efeb5c..d5417886 100644
--- a/com32/modules/Makefile
+++ b/com32/modules/Makefile
@@ -45,7 +45,7 @@ AUXDIR = $(LIBDIR)/syslinux
INCDIR = /usr/include
COM32DIR = $(AUXDIR)/com32
-MODULES = chain.c32 menu.c32
+MODULES = chain.c32 menu.c32 ethersel.c32
TESTFILES = menu.lnx
all: $(MODULES) $(TESTFILES)
diff --git a/com32/modules/ethersel.c b/com32/modules/ethersel.c
new file mode 100644
index 00000000..51ad2c69
--- /dev/null
+++ b/com32/modules/ethersel.c
@@ -0,0 +1,256 @@
+#ident "$Id$"
+/* ----------------------------------------------------------------------- *
+ *
+ * Copyright 2005 H. Peter Anvin - All Rights Reserved
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation, Inc., 53 Temple Place Ste 330,
+ * Boston MA 02111-1307, USA; either version 2 of the License, or
+ * (at your option) any later version; incorporated herein by reference.
+ *
+ * ----------------------------------------------------------------------- */
+
+/*
+ * ethersel.c
+ *
+ * Search for an Ethernet card with a known PCI signature, and run
+ * the corresponding Ethernet module.
+ *
+ * To use this, set up a syslinux config file like this:
+ *
+ * PROMPT 0
+ * DEFAULT ethersel.c32
+ * # DEV [DID xxxx:yyyy] [RID zz-zz] [SID uuuu:vvvv] commandline
+ * # ...
+ *
+ * DID = PCI device ID
+ * RID = Revision ID (range)
+ * SID = Subsystem ID
+ */
+
+#include <inttypes.h>
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <sys/pci.h>
+#include <com32.h>
+
+struct match {
+ struct match *next;
+ uint32_t did;
+ uint32_t did_mask;
+ uint32_t sid;
+ uint32_t sid_mask;
+ uint8_t rid_min, rid_max;
+ char *filename;
+};
+
+static const char *
+get_config(void)
+{
+ static com32sys_t r;
+
+ r.eax.w[0] = 0x000E;
+ __intcall(0x22, &r, &r);
+
+ return MK_PTR(r.es, r.ebx.w[0]);
+}
+
+static char *
+skipspace(char *p)
+{
+ while ( *p && *p <= ' ' )
+ p++;
+
+ return p;
+}
+
+#define MAX_LINE 512
+
+/* Check to see if we are at a certain keyword (case insensitive) */
+static int looking_at(const char *line, const char *kwd)
+{
+ const char *p = line;
+ const char *q = kwd;
+
+ while ( *p && *q && ((*p^*q) & ~0x20) == 0 ) {
+ p++;
+ q++;
+ }
+
+ if ( *q )
+ return 0; /* Didn't see the keyword */
+
+ return *p <= ' '; /* Must be EOL or whitespace */
+}
+
+static uint32_t
+get_did(char **ptr)
+{
+ unsigned long vid, did;
+
+ vid = strtoul(*ptr, ptr, 16);
+ if ( **ptr != ':' )
+ return -1; /* Bogus ID */
+ (*ptr)++;
+ did = strtoul(*ptr, ptr, 16);
+
+ return (did << 16) + vid;
+}
+
+static struct match *
+parse_config(const char *filename)
+{
+ char line[MAX_LINE], *p;
+ FILE *f;
+ struct match *list = NULL;
+ struct match **ep = &list;
+ struct match *m;
+
+ if ( !filename )
+ filename = get_config();
+
+ f = fopen(filename, "r");
+ if ( !f )
+ return list;
+
+ while ( fgets(line, sizeof line, f) ) {
+ p = skipspace(line);
+
+ if ( !looking_at(p, "#") )
+ continue;
+
+ p = skipspace(p+1);
+
+ if ( !looking_at(p, "dev") )
+ continue;
+
+ m = malloc(sizeof(struct match));
+ if ( !m )
+ continue;
+
+ memset(m, 0, sizeof *m);
+ m->rid_max = 0xff;
+
+ p += 3;
+
+ for(;;) {
+ p = skipspace(p);
+
+ if ( looking_at(p, "did") ) {
+ m->did = get_did(&p);
+ m->did_mask = 0xffffffff;
+ } else if ( looking_at(p, "sid") ) {
+ m->sid = get_did(&p);
+ m->sid_mask = 0xffffffff;
+ } else if ( looking_at(p, "rid") ) {
+ unsigned long r0, r1;
+
+ p = skipspace(p+3);
+
+ r0 = strtoul(p, &p, 16);
+ if ( *p == '-' ) {
+ r1 = strtoul(p+1, &p, 16);
+ } else {
+ r1 = r0;
+ }
+
+ m->rid_min = r0;
+ m->rid_max = r1;
+ } else {
+ char *e;
+
+ e = strchr(p, '\n');
+ if ( *e ) *e = '\0';
+ e = strchr(p, '\r');
+ if ( *e ) *e = '\0';
+
+ m->filename = strdup(p);
+ if ( !m->filename )
+ m->did = -1;
+ break; /* Done with this line */
+ }
+ }
+
+ *ep = m;
+ ep = &m->next;
+ }
+
+ return list;
+}
+
+static struct match *
+pciscan(struct match *list)
+{
+ unsigned int bus, dev, func, maxfunc;
+ uint32_t did, sid;
+ uint8_t hdrtype, rid;
+ pciaddr_t a;
+ struct match *m;
+
+ for ( bus = 0 ; bus <= 0xff ; bus++ ) {
+ for ( dev = 0 ; dev <= 0x1f ; dev++ ) {
+ maxfunc = 0;
+ for ( func = 0 ; func <= maxfunc ; func++ ) {
+ a = pci_mkaddr(bus, dev, func, 0);
+
+ did = pci_readl(a);
+
+ if ( did == 0xffffffff || did == 0xffff0000 ||
+ did == 0x0000ffff || did == 0x00000000 )
+ continue;
+
+ hdrtype = pci_readb(a + 0x0e);
+
+ if ( hdrtype & 0x80 )
+ maxfunc = 7; /* Multifunction device */
+
+ if ( hdrtype & 0x7f )
+ continue; /* Ignore bridge devices */
+
+ rid = pci_readb(a + 0x08);
+ sid = pci_readl(a + 0x2c);
+
+ for ( m = list ; m ; m = m->next ) {
+ if ( ((did ^ m->did) & m->did_mask) == 0 &&
+ ((sid ^ m->sid) & m->sid_mask) == 0 &&
+ rid >= m->rid_min && rid <= m->rid_max )
+ return m;
+ }
+ }
+ }
+ }
+
+ return NULL;
+}
+
+static void __attribute__((noreturn))
+execute(const char *cmdline)
+{
+ static com32sys_t ireg;
+
+ strcpy(__com32.cs_bounce, cmdline);
+ ireg.eax.w[0] = 0x0003; /* Run command */
+ ireg.ebx.w[0] = OFFS(__com32.cs_bounce);
+ ireg.es = SEG(__com32.cs_bounce);
+ __intcall(0x22, &ireg, NULL);
+ exit(255); /* Shouldn't return */
+}
+
+int main(int argc, char *argv[])
+{
+ struct match *list, *match;
+
+ list = parse_config(argc < 2 ? NULL : argv[1]);
+
+ match = pciscan(list);
+
+ if ( match )
+ execute(match->filename);
+
+ fputs("Error: no recognized network card found\n", stderr);
+
+ return 1;
+}
+