]> git.ipfire.org Git - thirdparty/pciutils.git/blame - lib/fbsd-device.c
fbsd-device should compile again
[thirdparty/pciutils.git] / lib / fbsd-device.c
CommitLineData
168b4f46
MM
1/*
2 * The PCI Library -- FreeBSD /dev/pci access
3 *
4 * Copyright (c) 1999 Jari Kirma <kirma@cs.hut.fi>
ab12277e 5 * Updated in 2003 by Samy Al Bahra <samy@kerneled.com>
0f3d0ca7 6 * Updated in 2017 by Imre Vadász <imrevdsz@gmail.com>
168b4f46
MM
7 *
8 * Can be freely distributed and used under the terms of the GNU GPL.
9 */
10
ac9956a8 11#include <errno.h>
168b4f46 12#include <fcntl.h>
ac9956a8 13#include <stdio.h>
0f3d0ca7 14#include <stdlib.h>
168b4f46
MM
15#include <string.h>
16#include <unistd.h>
ab12277e 17#include <osreldate.h>
d1058e9d
MM
18#include <stdint.h>
19
20#ifdef __FreeBSD_kernel_version
21# ifndef __FreeBSD_version
22# define __FreeBSD_version __FreeBSD_kernel_version
23# endif
24#endif
ab12277e 25
99091df9 26#if __FreeBSD_version < 430000 && !defined(__DragonFly__)
ac9956a8 27# include <pci/pcivar.h>
ab12277e
MM
28# include <pci/pci_ioctl.h>
29#else
30# include <sys/pciio.h>
31#endif
168b4f46
MM
32
33#include "internal.h"
34
35static void
36fbsd_config(struct pci_access *a)
37{
cb6ee324 38 pci_define_param(a, "fbsd.path", PCI_PATH_FBSD_DEVICE, "Path to the FreeBSD PCI device");
168b4f46
MM
39}
40
41static int
42fbsd_detect(struct pci_access *a)
43{
cb6ee324 44 char *name = pci_get_param(a, "fbsd.path");
168b4f46
MM
45
46 if (access(name, R_OK))
47 {
48 a->warning("Cannot open %s", name);
49 return 0;
50 }
51 a->debug("...using %s", name);
52 return 1;
53}
54
55static void
56fbsd_init(struct pci_access *a)
57{
cb6ee324 58 char *name = pci_get_param(a, "fbsd.path");
0f3d0ca7 59 int fd;
168b4f46 60
0f3d0ca7
IV
61 a->fd = -1;
62 a->fd_rw = -1;
63 /*
64 * When opening /dev/pci as read-write fails, retry with readonly which
65 * will still allow us to gain some information via the PCIOCGETCONF and
66 * PCIOCGETBAR IOCTLs, even without generic read access to the PCI config
67 * space.
68 */
69 fd = open(name, O_RDWR, 0);
70 if (fd < 0)
71 {
72 fd = open(name, O_RDONLY, 0);
73 if (fd < 0)
74 a->error("fbsd_init: %s open failed", name);
75 else
76 {
77 a->debug("fbsd_init: Fallback to read-only opened %s", name);
78 a->fd = fd;
79 }
80 }
81 else
82 a->fd_rw = fd;
168b4f46
MM
83}
84
85static void
86fbsd_cleanup(struct pci_access *a)
87{
0f3d0ca7
IV
88 if (a->fd >= 0)
89 {
90 close(a->fd);
91 a->fd = -1;
92 }
93 if (a->fd_rw >= 0)
94 {
95 close(a->fd_rw);
96 a->fd_rw = -1;
97 }
98}
99
100static void
101fbsd_scan(struct pci_access *a)
102{
103 struct pci_conf_io conf;
104 struct pci_conf *matches;
105 struct pci_dev *t;
106 uint32_t offset = 0;
107 unsigned int i;
108
109 matches = calloc(32, sizeof(struct pci_conf));
110 if (matches == NULL)
111 {
112 a->error("calloc: %s", strerror(errno));
113 return;
114 }
115
116 conf.generation = 0;
117 do
118 {
119 conf.pat_buf_len = 0;
120 conf.num_patterns = 0;
121 conf.patterns = NULL;
122 conf.match_buf_len = 32 * sizeof(struct pci_conf);
123 conf.num_matches = 32;
124 conf.matches = matches;
125 conf.offset = offset;
126 conf.status = 0;
127 if (ioctl(a->fd_rw >= 0 ? a->fd_rw : a->fd, PCIOCGETCONF, &conf) < 0)
128 {
129 if (errno == ENODEV)
130 break;
131 a->error("fbsd_scan: ioctl(PCIOCGETCONF) failed: %s",
132 strerror(errno));
133 }
134 /* PCI_GETCONF_LIST_CHANGED would require us to start over. */
135 if (conf.status == PCI_GETCONF_ERROR ||
136 conf.status == PCI_GETCONF_LIST_CHANGED)
137 {
138 a->error("fbsd_scan: ioctl(PCIOCGETCONF) failed");
139 break;
140 }
141 for (i = 0; i < conf.num_matches; i++)
142 {
143 t = pci_alloc_dev(a);
144 t->bus = matches[i].pc_sel.pc_bus;
145 t->dev = matches[i].pc_sel.pc_dev;
58d9f25f 146 t->func = matches[i].pc_sel.pc_func;
0f3d0ca7
IV
147 t->domain = matches[i].pc_sel.pc_domain;
148 t->domain_16 = matches[i].pc_sel.pc_domain;
149 t->vendor_id = matches[i].pc_vendor;
150 t->device_id = matches[i].pc_device;
151 t->known_fields = PCI_FILL_IDENT;
152 t->hdrtype = matches[i].pc_hdr;
153 pci_link_dev(a, t);
154 }
155 offset += conf.num_matches;
156 }
157 while (conf.status == PCI_GETCONF_MORE_DEVS);
158
159 free(matches);
160}
161
162static int
163fbsd_fill_info(struct pci_dev *d, int flags)
164{
165 struct pci_conf_io conf;
166 struct pci_bar_io bar;
167 struct pci_match_conf pattern;
168 struct pci_conf match;
169 int i;
170
171 if (d->access->fd_rw >= 0)
172 return pci_generic_fill_info(d, flags);
173
174 /*
175 * Can only handle PCI_FILL_IDENT, PCI_FILL_CLASS, PCI_FILL_BASES and
176 * PCI_FILL_SIZES requests with the PCIOCGETCONF and PCIOCGETBAR IOCTLs.
177 */
178
179 conf.pat_buf_len = sizeof(struct pci_match_conf);
180 conf.num_patterns = 1;
181 conf.patterns = &pattern;
182 conf.match_buf_len = sizeof(struct pci_conf);
183 conf.num_matches = 1;
184 conf.matches = &match;
185 conf.offset = 0;
186 conf.generation = 0;
187 conf.status = 0;
188
189 pattern.pc_sel.pc_domain = d->domain;
190 pattern.pc_sel.pc_bus = d->bus;
191 pattern.pc_sel.pc_dev = d->dev;
192 pattern.pc_sel.pc_func = d->func;
193 pattern.flags = PCI_GETCONF_MATCH_DOMAIN | PCI_GETCONF_MATCH_BUS |
194 PCI_GETCONF_MATCH_DEV | PCI_GETCONF_MATCH_FUNC;
195
196 if (ioctl(d->access->fd, PCIOCGETCONF, &conf) < 0)
197 {
198 if (errno == ENODEV)
199 return 0;
200 d->access->error("fbsd_fill_info: ioctl(PCIOCGETCONF) failed: %s", strerror(errno));
201 }
202
203 if (flags & PCI_FILL_IDENT)
204 {
205 d->vendor_id = match.pc_vendor;
206 d->device_id = match.pc_device;
207 }
208 if (flags & PCI_FILL_CLASS)
209 {
210 d->device_class = match.pc_class | (match.pc_subclass << 8);
211 }
212 if (flags & (PCI_FILL_BASES | PCI_FILL_SIZES))
213 {
214 d->rom_base_addr = 0;
215 d->rom_size = 0;
216 for (i = 0; i < 6; i++)
217 {
218 bar.pbi_sel.pc_domain = d->domain;
219 bar.pbi_sel.pc_bus = d->bus;
220 bar.pbi_sel.pc_dev = d->dev;
221 bar.pbi_sel.pc_func = d->func;
222 bar.pbi_reg = 0x10 + 4*i;
223 bar.pbi_enabled = 0;
224 bar.pbi_base = 0;
225 bar.pbi_length = 0;
226 if (ioctl(d->access->fd, PCIOCGETBAR, &bar) < 0)
227 {
228 if (errno == ENODEV)
229 return 0;
230 if (errno == EINVAL)
231 {
232 d->base_addr[i] = 0;
233 d->size[i] = 0;
234 }
235 else
236 d->access->error("fbsd_fill_info: ioctl(PCIOCGETBAR) failed: %s", strerror(errno));
237 }
238 else
239 {
240 d->base_addr[i] = bar.pbi_base;
241 d->size[i] = bar.pbi_length;
242 }
243 }
244 }
245
246 return flags & (PCI_FILL_IDENT | PCI_FILL_CLASS | PCI_FILL_BASES |
247 PCI_FILL_SIZES);
168b4f46
MM
248}
249
250static int
251fbsd_read(struct pci_dev *d, int pos, byte *buf, int len)
252{
253 struct pci_io pi;
254
0f3d0ca7
IV
255 if (d->access->fd_rw < 0)
256 {
6d2d713d 257 d->access->warning("fbsd_read: missing permissions");
0f3d0ca7
IV
258 return 0;
259 }
260
168b4f46 261 if (!(len == 1 || len == 2 || len == 4))
9c79fcc4 262 return pci_generic_block_read(d, pos, buf, len);
168b4f46 263
7663958f 264 if (pos >= 4096)
09817437
MM
265 return 0;
266
f4dbe106 267#if __FreeBSD_version >= 700053 || defined(__DragonFly__)
ac9956a8
MM
268 pi.pi_sel.pc_domain = d->domain;
269#endif
168b4f46
MM
270 pi.pi_sel.pc_bus = d->bus;
271 pi.pi_sel.pc_dev = d->dev;
272 pi.pi_sel.pc_func = d->func;
273
274 pi.pi_reg = pos;
275 pi.pi_width = len;
94db5c82 276
0f3d0ca7 277 if (ioctl(d->access->fd_rw, PCIOCREAD, &pi) < 0)
ac9956a8
MM
278 {
279 if (errno == ENODEV)
9c79fcc4 280 return 0;
ac9956a8
MM
281 d->access->error("fbsd_read: ioctl(PCIOCREAD) failed: %s", strerror(errno));
282 }
94db5c82 283
168b4f46
MM
284 switch (len)
285 {
286 case 1:
287 buf[0] = (u8) pi.pi_data;
288 break;
289 case 2:
ac9956a8 290 ((u16 *) buf)[0] = cpu_to_le16((u16) pi.pi_data);
168b4f46
MM
291 break;
292 case 4:
ac9956a8 293 ((u32 *) buf)[0] = cpu_to_le32((u32) pi.pi_data);
168b4f46
MM
294 break;
295 }
296 return 1;
297}
298
299static int
300fbsd_write(struct pci_dev *d, int pos, byte *buf, int len)
301{
302 struct pci_io pi;
303
0f3d0ca7
IV
304 if (d->access->fd_rw < 0)
305 {
6d2d713d 306 d->access->warning("fbsd_write: missing permissions");
0f3d0ca7
IV
307 return 0;
308 }
309
168b4f46 310 if (!(len == 1 || len == 2 || len == 4))
9c79fcc4 311 return pci_generic_block_write(d, pos, buf, len);
168b4f46 312
7663958f 313 if (pos >= 4096)
09817437
MM
314 return 0;
315
f4dbe106 316#if __FreeBSD_version >= 700053 || defined(__DragonFly__)
ac9956a8
MM
317 pi.pi_sel.pc_domain = d->domain;
318#endif
168b4f46
MM
319 pi.pi_sel.pc_bus = d->bus;
320 pi.pi_sel.pc_dev = d->dev;
321 pi.pi_sel.pc_func = d->func;
322
323 pi.pi_reg = pos;
324 pi.pi_width = len;
94db5c82 325
168b4f46
MM
326 switch (len)
327 {
328 case 1:
329 pi.pi_data = buf[0];
330 break;
331 case 2:
ac9956a8 332 pi.pi_data = le16_to_cpu(((u16 *) buf)[0]);
168b4f46
MM
333 break;
334 case 4:
ac9956a8 335 pi.pi_data = le32_to_cpu(((u32 *) buf)[0]);
168b4f46
MM
336 break;
337 }
94db5c82 338
0f3d0ca7 339 if (ioctl(d->access->fd_rw, PCIOCWRITE, &pi) < 0)
168b4f46 340 {
ac9956a8 341 if (errno == ENODEV)
9c79fcc4 342 return 0;
ac9956a8 343 d->access->error("fbsd_write: ioctl(PCIOCWRITE) failed: %s", strerror(errno));
168b4f46
MM
344 }
345
346 return 1;
347}
348
349struct pci_methods pm_fbsd_device = {
9ff67879
MM
350 "fbsd-device",
351 "FreeBSD /dev/pci device",
168b4f46
MM
352 fbsd_config,
353 fbsd_detect,
354 fbsd_init,
355 fbsd_cleanup,
0f3d0ca7
IV
356 fbsd_scan,
357 fbsd_fill_info,
168b4f46
MM
358 fbsd_read,
359 fbsd_write,
52c81519 360 NULL, /* read_vpd */
168b4f46
MM
361 NULL, /* dev_init */
362 NULL /* dev_cleanup */
363};