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) */ 46 static 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 62 static 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 89 static 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 108 static 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 178 int main(int argc, char *argv[]) 179 { 180 struct match *list, *match; 181 struct pci_domain *pci_domain; 182 183 pci_domain = pci_scan(); 184 185 if (pci_domain) { 186 list = parse_config(argc < 2 ? NULL : argv[1]); 187 188 match = find_pci_device(pci_domain, list); 189 190 if (match) 191 syslinux_run_command(match->filename); 192 } 193 194 /* On error, return to the command line */ 195 fputs("Error: no recognized network card found!\n", stderr); 196 return 1; 197 } 198
