1*c2e0c6b5SAndroid Build Coastguard Worker /*
2*c2e0c6b5SAndroid Build Coastguard Worker * The PCI Library -- Parsing of the ID list
3*c2e0c6b5SAndroid Build Coastguard Worker *
4*c2e0c6b5SAndroid Build Coastguard Worker * Copyright (c) 1997--2008 Martin Mares <[email protected]>
5*c2e0c6b5SAndroid Build Coastguard Worker *
6*c2e0c6b5SAndroid Build Coastguard Worker * Can be freely distributed and used under the terms of the GNU GPL v2+.
7*c2e0c6b5SAndroid Build Coastguard Worker *
8*c2e0c6b5SAndroid Build Coastguard Worker * SPDX-License-Identifier: GPL-2.0-or-later
9*c2e0c6b5SAndroid Build Coastguard Worker */
10*c2e0c6b5SAndroid Build Coastguard Worker
11*c2e0c6b5SAndroid Build Coastguard Worker #include <stdio.h>
12*c2e0c6b5SAndroid Build Coastguard Worker #include <stdlib.h>
13*c2e0c6b5SAndroid Build Coastguard Worker #include <string.h>
14*c2e0c6b5SAndroid Build Coastguard Worker #include <errno.h>
15*c2e0c6b5SAndroid Build Coastguard Worker
16*c2e0c6b5SAndroid Build Coastguard Worker #include "internal.h"
17*c2e0c6b5SAndroid Build Coastguard Worker #include "names.h"
18*c2e0c6b5SAndroid Build Coastguard Worker
19*c2e0c6b5SAndroid Build Coastguard Worker #ifdef PCI_COMPRESSED_IDS
20*c2e0c6b5SAndroid Build Coastguard Worker #include <zlib.h>
21*c2e0c6b5SAndroid Build Coastguard Worker typedef gzFile pci_file;
22*c2e0c6b5SAndroid Build Coastguard Worker #define pci_gets(f, l, s) gzgets(f, l, s)
23*c2e0c6b5SAndroid Build Coastguard Worker #define pci_eof(f) gzeof(f)
24*c2e0c6b5SAndroid Build Coastguard Worker
pci_open(struct pci_access * a)25*c2e0c6b5SAndroid Build Coastguard Worker static pci_file pci_open(struct pci_access *a)
26*c2e0c6b5SAndroid Build Coastguard Worker {
27*c2e0c6b5SAndroid Build Coastguard Worker pci_file result;
28*c2e0c6b5SAndroid Build Coastguard Worker size_t len;
29*c2e0c6b5SAndroid Build Coastguard Worker char *new_name;
30*c2e0c6b5SAndroid Build Coastguard Worker
31*c2e0c6b5SAndroid Build Coastguard Worker result = gzopen(a->id_file_name, "rb");
32*c2e0c6b5SAndroid Build Coastguard Worker if (result)
33*c2e0c6b5SAndroid Build Coastguard Worker return result;
34*c2e0c6b5SAndroid Build Coastguard Worker len = strlen(a->id_file_name);
35*c2e0c6b5SAndroid Build Coastguard Worker if (len < 3 || memcmp(a->id_file_name + len - 3, ".gz", 3) != 0)
36*c2e0c6b5SAndroid Build Coastguard Worker return result;
37*c2e0c6b5SAndroid Build Coastguard Worker new_name = malloc(len - 2);
38*c2e0c6b5SAndroid Build Coastguard Worker memcpy(new_name, a->id_file_name, len - 3);
39*c2e0c6b5SAndroid Build Coastguard Worker new_name[len - 3] = 0;
40*c2e0c6b5SAndroid Build Coastguard Worker pci_set_name_list_path(a, new_name, 1);
41*c2e0c6b5SAndroid Build Coastguard Worker return gzopen(a->id_file_name, "rb");
42*c2e0c6b5SAndroid Build Coastguard Worker }
43*c2e0c6b5SAndroid Build Coastguard Worker
44*c2e0c6b5SAndroid Build Coastguard Worker #define pci_close(f) gzclose(f)
45*c2e0c6b5SAndroid Build Coastguard Worker #define PCI_ERROR(f, err) \
46*c2e0c6b5SAndroid Build Coastguard Worker if (!err) { \
47*c2e0c6b5SAndroid Build Coastguard Worker int errnum = 0; \
48*c2e0c6b5SAndroid Build Coastguard Worker gzerror(f, &errnum); \
49*c2e0c6b5SAndroid Build Coastguard Worker if (errnum >= 0) err = NULL; \
50*c2e0c6b5SAndroid Build Coastguard Worker else if (errnum == Z_ERRNO) err = "I/O error"; \
51*c2e0c6b5SAndroid Build Coastguard Worker else err = zError(errnum); \
52*c2e0c6b5SAndroid Build Coastguard Worker }
53*c2e0c6b5SAndroid Build Coastguard Worker #else
54*c2e0c6b5SAndroid Build Coastguard Worker typedef FILE * pci_file;
55*c2e0c6b5SAndroid Build Coastguard Worker #define pci_gets(f, l, s) fgets(l, s, f)
56*c2e0c6b5SAndroid Build Coastguard Worker #define pci_eof(f) feof(f)
57*c2e0c6b5SAndroid Build Coastguard Worker #define pci_open(a) fopen(a->id_file_name, "r")
58*c2e0c6b5SAndroid Build Coastguard Worker #define pci_close(f) fclose(f)
59*c2e0c6b5SAndroid Build Coastguard Worker #define PCI_ERROR(f, err) if (!err && ferror(f)) err = "I/O error";
60*c2e0c6b5SAndroid Build Coastguard Worker #endif
61*c2e0c6b5SAndroid Build Coastguard Worker
id_hex(char * p,int cnt)62*c2e0c6b5SAndroid Build Coastguard Worker static int id_hex(char *p, int cnt)
63*c2e0c6b5SAndroid Build Coastguard Worker {
64*c2e0c6b5SAndroid Build Coastguard Worker int x = 0;
65*c2e0c6b5SAndroid Build Coastguard Worker while (cnt--)
66*c2e0c6b5SAndroid Build Coastguard Worker {
67*c2e0c6b5SAndroid Build Coastguard Worker x <<= 4;
68*c2e0c6b5SAndroid Build Coastguard Worker if (*p >= '0' && *p <= '9')
69*c2e0c6b5SAndroid Build Coastguard Worker x += (*p - '0');
70*c2e0c6b5SAndroid Build Coastguard Worker else if (*p >= 'a' && *p <= 'f')
71*c2e0c6b5SAndroid Build Coastguard Worker x += (*p - 'a' + 10);
72*c2e0c6b5SAndroid Build Coastguard Worker else if (*p >= 'A' && *p <= 'F')
73*c2e0c6b5SAndroid Build Coastguard Worker x += (*p - 'A' + 10);
74*c2e0c6b5SAndroid Build Coastguard Worker else
75*c2e0c6b5SAndroid Build Coastguard Worker return -1;
76*c2e0c6b5SAndroid Build Coastguard Worker p++;
77*c2e0c6b5SAndroid Build Coastguard Worker }
78*c2e0c6b5SAndroid Build Coastguard Worker return x;
79*c2e0c6b5SAndroid Build Coastguard Worker }
80*c2e0c6b5SAndroid Build Coastguard Worker
id_white_p(int c)81*c2e0c6b5SAndroid Build Coastguard Worker static inline int id_white_p(int c)
82*c2e0c6b5SAndroid Build Coastguard Worker {
83*c2e0c6b5SAndroid Build Coastguard Worker return (c == ' ') || (c == '\t');
84*c2e0c6b5SAndroid Build Coastguard Worker }
85*c2e0c6b5SAndroid Build Coastguard Worker
86*c2e0c6b5SAndroid Build Coastguard Worker
id_parse_list(struct pci_access * a,pci_file f,int * lino)87*c2e0c6b5SAndroid Build Coastguard Worker static const char *id_parse_list(struct pci_access *a, pci_file f, int *lino)
88*c2e0c6b5SAndroid Build Coastguard Worker {
89*c2e0c6b5SAndroid Build Coastguard Worker char line[MAX_LINE];
90*c2e0c6b5SAndroid Build Coastguard Worker char *p;
91*c2e0c6b5SAndroid Build Coastguard Worker int id1=0, id2=0, id3=0, id4=0;
92*c2e0c6b5SAndroid Build Coastguard Worker int cat = -1;
93*c2e0c6b5SAndroid Build Coastguard Worker int nest;
94*c2e0c6b5SAndroid Build Coastguard Worker static const char parse_error[] = "Parse error";
95*c2e0c6b5SAndroid Build Coastguard Worker
96*c2e0c6b5SAndroid Build Coastguard Worker *lino = 0;
97*c2e0c6b5SAndroid Build Coastguard Worker while (pci_gets(f, line, sizeof(line)))
98*c2e0c6b5SAndroid Build Coastguard Worker {
99*c2e0c6b5SAndroid Build Coastguard Worker (*lino)++;
100*c2e0c6b5SAndroid Build Coastguard Worker p = line;
101*c2e0c6b5SAndroid Build Coastguard Worker while (*p && *p != '\n' && *p != '\r')
102*c2e0c6b5SAndroid Build Coastguard Worker p++;
103*c2e0c6b5SAndroid Build Coastguard Worker if (!*p && !pci_eof(f))
104*c2e0c6b5SAndroid Build Coastguard Worker return "Line too long";
105*c2e0c6b5SAndroid Build Coastguard Worker *p = 0;
106*c2e0c6b5SAndroid Build Coastguard Worker if (p > line && (p[-1] == ' ' || p[-1] == '\t'))
107*c2e0c6b5SAndroid Build Coastguard Worker *--p = 0;
108*c2e0c6b5SAndroid Build Coastguard Worker
109*c2e0c6b5SAndroid Build Coastguard Worker p = line;
110*c2e0c6b5SAndroid Build Coastguard Worker while (id_white_p(*p))
111*c2e0c6b5SAndroid Build Coastguard Worker p++;
112*c2e0c6b5SAndroid Build Coastguard Worker if (!*p || *p == '#')
113*c2e0c6b5SAndroid Build Coastguard Worker continue;
114*c2e0c6b5SAndroid Build Coastguard Worker
115*c2e0c6b5SAndroid Build Coastguard Worker p = line;
116*c2e0c6b5SAndroid Build Coastguard Worker while (*p == '\t')
117*c2e0c6b5SAndroid Build Coastguard Worker p++;
118*c2e0c6b5SAndroid Build Coastguard Worker nest = p - line;
119*c2e0c6b5SAndroid Build Coastguard Worker
120*c2e0c6b5SAndroid Build Coastguard Worker if (!nest) /* Top-level entries */
121*c2e0c6b5SAndroid Build Coastguard Worker {
122*c2e0c6b5SAndroid Build Coastguard Worker if (p[0] == 'C' && p[1] == ' ') /* Class block */
123*c2e0c6b5SAndroid Build Coastguard Worker {
124*c2e0c6b5SAndroid Build Coastguard Worker if ((id1 = id_hex(p+2, 2)) < 0 || !id_white_p(p[4]))
125*c2e0c6b5SAndroid Build Coastguard Worker return parse_error;
126*c2e0c6b5SAndroid Build Coastguard Worker cat = ID_CLASS;
127*c2e0c6b5SAndroid Build Coastguard Worker p += 5;
128*c2e0c6b5SAndroid Build Coastguard Worker }
129*c2e0c6b5SAndroid Build Coastguard Worker else if (p[0] == 'S' && p[1] == ' ')
130*c2e0c6b5SAndroid Build Coastguard Worker { /* Generic subsystem block */
131*c2e0c6b5SAndroid Build Coastguard Worker if ((id1 = id_hex(p+2, 4)) < 0 || p[6])
132*c2e0c6b5SAndroid Build Coastguard Worker return parse_error;
133*c2e0c6b5SAndroid Build Coastguard Worker if (!pci_id_lookup(a, 0, ID_VENDOR, id1, 0, 0, 0))
134*c2e0c6b5SAndroid Build Coastguard Worker return "Vendor does not exist";
135*c2e0c6b5SAndroid Build Coastguard Worker cat = ID_GEN_SUBSYSTEM;
136*c2e0c6b5SAndroid Build Coastguard Worker continue;
137*c2e0c6b5SAndroid Build Coastguard Worker }
138*c2e0c6b5SAndroid Build Coastguard Worker else if (p[0] >= 'A' && p[0] <= 'Z' && p[1] == ' ')
139*c2e0c6b5SAndroid Build Coastguard Worker { /* Unrecognized block (RFU) */
140*c2e0c6b5SAndroid Build Coastguard Worker cat = ID_UNKNOWN;
141*c2e0c6b5SAndroid Build Coastguard Worker continue;
142*c2e0c6b5SAndroid Build Coastguard Worker }
143*c2e0c6b5SAndroid Build Coastguard Worker else /* Vendor ID */
144*c2e0c6b5SAndroid Build Coastguard Worker {
145*c2e0c6b5SAndroid Build Coastguard Worker if ((id1 = id_hex(p, 4)) < 0 || !id_white_p(p[4]))
146*c2e0c6b5SAndroid Build Coastguard Worker return parse_error;
147*c2e0c6b5SAndroid Build Coastguard Worker cat = ID_VENDOR;
148*c2e0c6b5SAndroid Build Coastguard Worker p += 5;
149*c2e0c6b5SAndroid Build Coastguard Worker }
150*c2e0c6b5SAndroid Build Coastguard Worker id2 = id3 = id4 = 0;
151*c2e0c6b5SAndroid Build Coastguard Worker }
152*c2e0c6b5SAndroid Build Coastguard Worker else if (cat == ID_UNKNOWN) /* Nested entries in RFU blocks are skipped */
153*c2e0c6b5SAndroid Build Coastguard Worker continue;
154*c2e0c6b5SAndroid Build Coastguard Worker else if (nest == 1) /* Nesting level 1 */
155*c2e0c6b5SAndroid Build Coastguard Worker switch (cat)
156*c2e0c6b5SAndroid Build Coastguard Worker {
157*c2e0c6b5SAndroid Build Coastguard Worker case ID_VENDOR:
158*c2e0c6b5SAndroid Build Coastguard Worker case ID_DEVICE:
159*c2e0c6b5SAndroid Build Coastguard Worker case ID_SUBSYSTEM:
160*c2e0c6b5SAndroid Build Coastguard Worker if ((id2 = id_hex(p, 4)) < 0 || !id_white_p(p[4]))
161*c2e0c6b5SAndroid Build Coastguard Worker return parse_error;
162*c2e0c6b5SAndroid Build Coastguard Worker p += 5;
163*c2e0c6b5SAndroid Build Coastguard Worker cat = ID_DEVICE;
164*c2e0c6b5SAndroid Build Coastguard Worker id3 = id4 = 0;
165*c2e0c6b5SAndroid Build Coastguard Worker break;
166*c2e0c6b5SAndroid Build Coastguard Worker case ID_GEN_SUBSYSTEM:
167*c2e0c6b5SAndroid Build Coastguard Worker if ((id2 = id_hex(p, 4)) < 0 || !id_white_p(p[4]))
168*c2e0c6b5SAndroid Build Coastguard Worker return parse_error;
169*c2e0c6b5SAndroid Build Coastguard Worker p += 5;
170*c2e0c6b5SAndroid Build Coastguard Worker id3 = id4 = 0;
171*c2e0c6b5SAndroid Build Coastguard Worker break;
172*c2e0c6b5SAndroid Build Coastguard Worker case ID_CLASS:
173*c2e0c6b5SAndroid Build Coastguard Worker case ID_SUBCLASS:
174*c2e0c6b5SAndroid Build Coastguard Worker case ID_PROGIF:
175*c2e0c6b5SAndroid Build Coastguard Worker if ((id2 = id_hex(p, 2)) < 0 || !id_white_p(p[2]))
176*c2e0c6b5SAndroid Build Coastguard Worker return parse_error;
177*c2e0c6b5SAndroid Build Coastguard Worker p += 3;
178*c2e0c6b5SAndroid Build Coastguard Worker cat = ID_SUBCLASS;
179*c2e0c6b5SAndroid Build Coastguard Worker id3 = id4 = 0;
180*c2e0c6b5SAndroid Build Coastguard Worker break;
181*c2e0c6b5SAndroid Build Coastguard Worker default:
182*c2e0c6b5SAndroid Build Coastguard Worker return parse_error;
183*c2e0c6b5SAndroid Build Coastguard Worker }
184*c2e0c6b5SAndroid Build Coastguard Worker else if (nest == 2) /* Nesting level 2 */
185*c2e0c6b5SAndroid Build Coastguard Worker switch (cat)
186*c2e0c6b5SAndroid Build Coastguard Worker {
187*c2e0c6b5SAndroid Build Coastguard Worker case ID_DEVICE:
188*c2e0c6b5SAndroid Build Coastguard Worker case ID_SUBSYSTEM:
189*c2e0c6b5SAndroid Build Coastguard Worker if ((id3 = id_hex(p, 4)) < 0 || !id_white_p(p[4]) || (id4 = id_hex(p+5, 4)) < 0 || !id_white_p(p[9]))
190*c2e0c6b5SAndroid Build Coastguard Worker return parse_error;
191*c2e0c6b5SAndroid Build Coastguard Worker p += 10;
192*c2e0c6b5SAndroid Build Coastguard Worker cat = ID_SUBSYSTEM;
193*c2e0c6b5SAndroid Build Coastguard Worker break;
194*c2e0c6b5SAndroid Build Coastguard Worker case ID_CLASS:
195*c2e0c6b5SAndroid Build Coastguard Worker case ID_SUBCLASS:
196*c2e0c6b5SAndroid Build Coastguard Worker case ID_PROGIF:
197*c2e0c6b5SAndroid Build Coastguard Worker if ((id3 = id_hex(p, 2)) < 0 || !id_white_p(p[2]))
198*c2e0c6b5SAndroid Build Coastguard Worker return parse_error;
199*c2e0c6b5SAndroid Build Coastguard Worker p += 3;
200*c2e0c6b5SAndroid Build Coastguard Worker cat = ID_PROGIF;
201*c2e0c6b5SAndroid Build Coastguard Worker id4 = 0;
202*c2e0c6b5SAndroid Build Coastguard Worker break;
203*c2e0c6b5SAndroid Build Coastguard Worker default:
204*c2e0c6b5SAndroid Build Coastguard Worker return parse_error;
205*c2e0c6b5SAndroid Build Coastguard Worker }
206*c2e0c6b5SAndroid Build Coastguard Worker else /* Nesting level 3 or more */
207*c2e0c6b5SAndroid Build Coastguard Worker return parse_error;
208*c2e0c6b5SAndroid Build Coastguard Worker while (id_white_p(*p))
209*c2e0c6b5SAndroid Build Coastguard Worker p++;
210*c2e0c6b5SAndroid Build Coastguard Worker if (!*p)
211*c2e0c6b5SAndroid Build Coastguard Worker return parse_error;
212*c2e0c6b5SAndroid Build Coastguard Worker if (pci_id_insert(a, cat, id1, id2, id3, id4, p, SRC_LOCAL))
213*c2e0c6b5SAndroid Build Coastguard Worker return "Duplicate entry";
214*c2e0c6b5SAndroid Build Coastguard Worker }
215*c2e0c6b5SAndroid Build Coastguard Worker return NULL;
216*c2e0c6b5SAndroid Build Coastguard Worker }
217*c2e0c6b5SAndroid Build Coastguard Worker
218*c2e0c6b5SAndroid Build Coastguard Worker int
pci_load_name_list(struct pci_access * a)219*c2e0c6b5SAndroid Build Coastguard Worker pci_load_name_list(struct pci_access *a)
220*c2e0c6b5SAndroid Build Coastguard Worker {
221*c2e0c6b5SAndroid Build Coastguard Worker pci_file f;
222*c2e0c6b5SAndroid Build Coastguard Worker int lino;
223*c2e0c6b5SAndroid Build Coastguard Worker const char *err;
224*c2e0c6b5SAndroid Build Coastguard Worker
225*c2e0c6b5SAndroid Build Coastguard Worker pci_free_name_list(a);
226*c2e0c6b5SAndroid Build Coastguard Worker a->id_load_attempted = 1;
227*c2e0c6b5SAndroid Build Coastguard Worker if (!(f = pci_open(a)))
228*c2e0c6b5SAndroid Build Coastguard Worker return 0;
229*c2e0c6b5SAndroid Build Coastguard Worker err = id_parse_list(a, f, &lino);
230*c2e0c6b5SAndroid Build Coastguard Worker PCI_ERROR(f, err);
231*c2e0c6b5SAndroid Build Coastguard Worker pci_close(f);
232*c2e0c6b5SAndroid Build Coastguard Worker if (err)
233*c2e0c6b5SAndroid Build Coastguard Worker a->error("%s at %s, line %d\n", err, a->id_file_name, lino);
234*c2e0c6b5SAndroid Build Coastguard Worker return 1;
235*c2e0c6b5SAndroid Build Coastguard Worker }
236*c2e0c6b5SAndroid Build Coastguard Worker
237*c2e0c6b5SAndroid Build Coastguard Worker void
pci_free_name_list(struct pci_access * a)238*c2e0c6b5SAndroid Build Coastguard Worker pci_free_name_list(struct pci_access *a)
239*c2e0c6b5SAndroid Build Coastguard Worker {
240*c2e0c6b5SAndroid Build Coastguard Worker pci_id_cache_flush(a);
241*c2e0c6b5SAndroid Build Coastguard Worker pci_id_hash_free(a);
242*c2e0c6b5SAndroid Build Coastguard Worker pci_id_hwdb_free(a);
243*c2e0c6b5SAndroid Build Coastguard Worker a->id_load_attempted = 0;
244*c2e0c6b5SAndroid Build Coastguard Worker }
245*c2e0c6b5SAndroid Build Coastguard Worker
246*c2e0c6b5SAndroid Build Coastguard Worker void
pci_set_name_list_path(struct pci_access * a,char * name,int to_be_freed)247*c2e0c6b5SAndroid Build Coastguard Worker pci_set_name_list_path(struct pci_access *a, char *name, int to_be_freed)
248*c2e0c6b5SAndroid Build Coastguard Worker {
249*c2e0c6b5SAndroid Build Coastguard Worker if (a->free_id_name)
250*c2e0c6b5SAndroid Build Coastguard Worker free(a->id_file_name);
251*c2e0c6b5SAndroid Build Coastguard Worker a->id_file_name = name;
252*c2e0c6b5SAndroid Build Coastguard Worker a->free_id_name = to_be_freed;
253*c2e0c6b5SAndroid Build Coastguard Worker }
254