LXR syslinux/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 <ctype.h>
  34#include <stdlib.h>
  35#include <string.h>
  36#include <console.h>
  37#include <sys/pci.h>
  38#include <com32.h>
  39#include <syslinux/boot.h>
  40#include <syslinux/config.h>
  41#include <dprintf.h>
  42
  43#define MAX_LINE 512
  44
  45/* Check to see if we are at a certain keyword (case insensitive) */
  46static int looking_at(const char *line, const char *kwd)
  47{
  48    const char *p = line;
  49    const char *q = kwd;
  50
  51    while (*p && *q && ((*p ^ *q) & ~0x20) == 0) {
  52        p++;
  53        q++;
  54    }
  55
  56    if (*q)
  57        return 0;               /* Didn't see the keyword */
  58
  59    return *p <= ' ';           /* Must be EOL or whitespace */
  60}
  61
  62static char *get_did(char *p, uint32_t * idptr, uint32_t * maskptr)
  63{
  64    unsigned long vid, did, m1, m2;
  65
  66    *idptr = -1;
  67    *maskptr = 0xffffffff;
  68
  69    vid = strtoul(p, &p, 16);
  70    if (*p != ':')
  71        return p;               /* Bogus ID */
  72    did = strtoul(p + 1, &p, 16);
  73
  74    *idptr = (did << 16) + vid;
  75
  76    if (*p == '/') {
  77        m1 = strtoul(p + 1, &p, 16);
  78        if (*p != ':') {
  79            *maskptr = (m1 << 16) | 0xffff;
  80        } else {
  81            m2 = strtoul(p + 1, &p, 16);
  82            *maskptr = (m1 << 16) | m2;
  83        }
  84    }
  85
  86    return p;
  87}
  88
  89static char *get_rid_range(char *p, uint8_t * rid_min, uint8_t * rid_max)
  90{
  91    unsigned long r0, r1;
  92
  93    p = skipspace(p + 3);
  94
  95    r0 = strtoul(p, &p, 16);
  96    if (*p == '-') {
  97        r1 = strtoul(p + 1, &p, 16);
  98    } else {
  99        r1 = r0;
 100    }
 101
 102    *rid_min = r0;
 103    *rid_max = r1;
 104
 105    return p;
 106}
 107
 108static struct match *parse_config(const char *filename)
 109{
 110    char line[MAX_LINE], *p;
 111    FILE *f;
 112    struct match *list = NULL;
 113    struct match **ep = &list;
 114    struct match *m;
 115
 116    if (!filename)
 117        filename = syslinux_config_file();
 118
 119    f = fopen(filename, "r");
 120    if (!f)
 121        return list;
 122
 123    while (fgets(line, sizeof line, f)) {
 124        p = skipspace(line);
 125
 126        if (!looking_at(p, "#"))
 127            continue;
 128        p = skipspace(p + 1);
 129
 130        if (!looking_at(p, "dev"))
 131            continue;
 132        p = skipspace(p + 3);
 133
 134        m = malloc(sizeof(struct match));
 135        if (!m)
 136            continue;
 137
 138        memset(m, 0, sizeof *m);
 139        m->rid_max = 0xff;
 140
 141        for (;;) {
 142            p = skipspace(p);
 143
 144            if (looking_at(p, "did")) {
 145                p = get_did(p + 3, &m->did, &m->did_mask);
 146            } else if (looking_at(p, "sid")) {
 147                p = get_did(p + 3, &m->sid, &m->sid_mask);
 148            } else if (looking_at(p, "rid")) {
 149                p = get_rid_range(p + 3, &m->rid_min, &m->rid_max);
 150            } else {
 151                char *e;
 152
 153                e = strchr(p, '\n');
 154                if (*e)
 155                    *e = '\0';
 156                e = strchr(p, '\r');
 157                if (*e)
 158                    *e = '\0';
 159
 160                m->filename = strdup(p);
 161                if (!m->filename)
 162                    m->did = -1;
 163                break;          /* Done with this line */
 164            }
 165        }
 166
 167        dprintf("DEV DID %08x/%08x SID %08x/%08x RID %02x-%02x CMD %s\n",
 168                m->did, m->did_mask, m->sid, m->sid_mask,
 169                m->rid_min, m->rid_max, m->filename);
 170
 171        *ep = m;
 172        ep = &m->next;
 173    }
 174
 175    return list;
 176}
 177
 178int main(int argc, char *argv[])
 179{
 180    struct match *list, *match;
 181    struct pci_domain *pci_domain;
 182
 183    openconsole(&dev_null_r, &dev_stdcon_w);
 184    pci_domain = pci_scan();
 185
 186    if (pci_domain) {
 187        list = parse_config(argc < 2 ? NULL : argv[1]);
 188
 189        match = find_pci_device(pci_domain, list);
 190
 191        if (match)
 192            syslinux_run_command(match->filename);
 193    }
 194
 195    /* On error, return to the command line */
 196    fputs("Error: no recognized network card found!\n", stderr);
 197    return 1;
 198}
 199