com32/modules/ethersel.c

   1 /* ----------------------------------------------------------------------- *
   2  *
   3  *   Copyright 2005-2008 H. Peter Anvin - All Rights Reserved
   4  *
   5  *   This program is free software; you can redistribute it and/or modify
   6  *   it under the terms of the GNU General Public License as published by
   7  *   the Free Software Foundation, Inc., 53 Temple Place Ste 330,
   8  *   Boston MA 02111-1307, USA; either version 2 of the License, or
   9  *   (at your option) any later version; incorporated herein by reference.
  10  *
  11  * ----------------------------------------------------------------------- */
  12
  13 /*
  14  * ethersel.c
  15  *
  16  * Search for an Ethernet card with a known PCI signature, and run
  17  * the corresponding Ethernet module.
  18  *
  19  * To use this, set up a syslinux config file like this:
  20  *
  21  * PROMPT 0
  22  * DEFAULT ethersel.c32
  23  * # DEV [DID xxxx:yyyy[/mask]] [RID zz-zz] [SID uuuu:vvvv[/mask]] commandline
  24  * # ...
  25  *
  26  * DID = PCI device ID
  27  * RID = Revision ID (range)
  28  * SID = Subsystem ID
  29  */
  30
  31 #include <inttypes.h>
  32 #include <stdio.h>
  33 #include <stdlib.h>
  34 #include <string.h>
  35 #include <console.h>
  36 #include <sys/pci.h>
  37 #include <com32.h>
  38 #include <syslinux/boot.h>
  39 #include <syslinux/config.h>
  40
  41 #ifdef DEBUG
  42 # define dprintf printf
  43 #else
  44 # define dprintf(...) ((void)0)
  45 #endif
  46
  47 static char *skipspace(char *p)
  48 {
  49     while (*p && *p <= ' ')
  50         p++;
  51
  52     return p;
  53 }
  54
  55 #define MAX_LINE 512
  56
  57 /* Check to see if we are at a certain keyword (case insensitive) */
  58 static int looking_at(const char *line, const char *kwd)
  59 {
  60     const char *p = line;
  61     const char *q = kwd;
  62
  63     while (*p && *q && ((*p ^ *q) & ~0x20) == 0) {
  64         p++;
  65         q++;
  66     }
  67
  68     if (*q)
  69         return 0;               /* Didn't see the keyword */
  70
  71     return *p <= ' ';           /* Must be EOL or whitespace */
  72 }
  73
  74 static char *get_did(char *p, uint32_t * idptr, uint32_t * maskptr)
  75 {
  76     unsigned long vid, did, m1, m2;
  77
  78     *idptr = -1;
  79     *maskptr = 0xffffffff;
  80
  81     vid = strtoul(p, &p, 16);
  82     if (*p != ':')
  83         return p;               /* Bogus ID */
  84     did = strtoul(p + 1, &p, 16);
  85
  86     *idptr = (did << 16) + vid;
  87
  88     if (*p == '/') {
  89         m1 = strtoul(p + 1, &p, 16);
  90         if (*p != ':') {
  91             *maskptr = (m1 << 16) | 0xffff;
  92         } else {
  93             m2 = strtoul(p + 1, &p, 16);
  94             *maskptr = (m1 << 16) | m2;
  95         }
  96     }
  97
  98     return p;
  99 }
 100
 101 static char *get_rid_range(char *p, uint8_t * rid_min, uint8_t * rid_max)
 102 {
 103     unsigned long r0, r1;
 104
 105     p = skipspace(p + 3);
 106
 107     r0 = strtoul(p, &p, 16);
 108     if (*p == '-') {
 109         r1 = strtoul(p + 1, &p, 16);
 110     } else {
 111         r1 = r0;
 112     }
 113
 114     *rid_min = r0;
 115     *rid_max = r1;
 116
 117     return p;
 118 }
 119
 120 static struct match *parse_config(const char *filename)
 121 {
 122     char line[MAX_LINE], *p;
 123     FILE *f;
 124     struct match *list = NULL;
 125     struct match **ep = &list;
 126     struct match *m;
 127
 128     if (!filename)
 129         filename = syslinux_config_file();
 130
 131     f = fopen(filename, "r");
 132     if (!f)
 133         return list;
 134
 135     while (fgets(line, sizeof line, f)) {
 136         p = skipspace(line);
 137
 138         if (!looking_at(p, "#"))
 139             continue;
 140         p = skipspace(p + 1);
 141
 142         if (!looking_at(p, "dev"))
 143             continue;
 144         p = skipspace(p + 3);
 145
 146         m = malloc(sizeof(struct match));
 147         if (!m)
 148             continue;
 149
 150         memset(m, 0, sizeof *m);
 151         m->rid_max = 0xff;
 152
 153         for (;;) {
 154             p = skipspace(p);
 155
 156             if (looking_at(p, "did")) {
 157                 p = get_did(p + 3, &m->did, &m->did_mask);
 158             } else if (looking_at(p, "sid")) {
 159                 p = get_did(p + 3, &m->sid, &m->sid_mask);
 160             } else if (looking_at(p, "rid")) {
 161                 p = get_rid_range(p + 3, &m->rid_min, &m->rid_max);
 162             } else {
 163                 char *e;
 164
 165                 e = strchr(p, '\n');
 166                 if (*e)
 167                     *e = '\0';
 168                 e = strchr(p, '\r');
 169                 if (*e)
 170                     *e = '\0';
 171
 172                 m->filename = strdup(p);
 173                 if (!m->filename)
 174                     m->did = -1;
 175                 break;          /* Done with this line */
 176             }
 177         }
 178
 179         dprintf("DEV DID %08x/%08x SID %08x/%08x RID %02x-%02x CMD %s\n",
 180                 m->did, m->did_mask, m->sid, m->sid_mask,
 181                 m->rid_min, m->rid_max, m->filename);
 182
 183         *ep = m;
 184         ep = &m->next;
 185     }
 186
 187     return list;
 188 }
 189
 190 int main(int argc, char *argv[])
 191 {
 192     struct match *list, *match;
 193     struct pci_domain *pci_domain;
 194
 195     openconsole(&dev_null_r, &dev_stdcon_w);
 196     pci_domain = pci_scan();
 197
 198     if (pci_domain) {
 199         list = parse_config(argc < 2 ? NULL : argv[1]);
 200
 201         match = find_pci_device(pci_domain, list);
 202
 203         if (match)
 204             syslinux_run_command(match->filename);
 205     }
 206
 207     /* On error, return to the command line */
 208     fputs("Error: no recognized network card found!\n", stderr);
 209     return 1;
 210 }