1 /*
2 * The PCI Library -- OpenBSD /dev/pci access
3 *
4 * Adapted from fbsd-device.c by Matthieu Herrb <[email protected]>, 2006
5 *
6 * Can be freely distributed and used under the terms of the GNU GPL v2+.
7 *
8 * SPDX-License-Identifier: GPL-2.0-or-later
9 */
10
11 #include <fcntl.h>
12 #include <string.h>
13 #include <unistd.h>
14 #include <errno.h>
15 #include <sys/endian.h>
16 #include <sys/types.h>
17 #include <sys/ioctl.h>
18 #include <sys/pciio.h>
19 #include "internal.h"
20
21 static void
obsd_config(struct pci_access * a)22 obsd_config(struct pci_access *a)
23 {
24 pci_define_param(a, "obsd.path", PCI_PATH_OBSD_DEVICE, "Path to the OpenBSD PCI device");
25 }
26
27 static int
obsd_detect(struct pci_access * a)28 obsd_detect(struct pci_access *a)
29 {
30 char *name = pci_get_param(a, "obsd.path");
31
32 if (access(name, R_OK))
33 {
34 a->warning("Cannot open %s", name);
35 return 0;
36 }
37 a->debug("...using %s", name);
38 return 1;
39 }
40
41 static void
obsd_init(struct pci_access * a)42 obsd_init(struct pci_access *a)
43 {
44 char *name = pci_get_param(a, "obsd.path");
45
46 a->fd = open(name, O_RDWR, 0);
47 if (a->fd < 0)
48 a->error("obsd_init: %s open failed", name);
49 }
50
51 static void
obsd_cleanup(struct pci_access * a)52 obsd_cleanup(struct pci_access *a)
53 {
54 close(a->fd);
55 }
56
57 static int
obsd_read(struct pci_dev * d,int pos,byte * buf,int len)58 obsd_read(struct pci_dev *d, int pos, byte *buf, int len)
59 {
60 struct pci_io pi;
61 union {
62 u_int32_t u32;
63 u_int16_t u16[2];
64 u_int8_t u8[4];
65 } u;
66
67 if (!(len == 1 || len == 2 || len == 4))
68 return pci_generic_block_read(d, pos, buf, len);
69
70 if (d->domain || pos >= 256)
71 return 0;
72
73 pi.pi_sel.pc_bus = d->bus;
74 pi.pi_sel.pc_dev = d->dev;
75 pi.pi_sel.pc_func = d->func;
76
77 pi.pi_reg = pos - (pos % 4);
78 pi.pi_width = 4;
79
80 if (ioctl(d->access->fd, PCIOCREAD, &pi) < 0) {
81 if (errno == ENXIO)
82 pi.pi_data = 0xffffffff;
83 else
84 d->access->error("obsd_read: ioctl(PCIOCREAD) failed");
85 }
86 u.u32 = pi.pi_data;
87
88 switch (len)
89 {
90 case 1:
91 buf[0] = (u8) u.u8[pos % 4];
92 break;
93 case 2:
94 ((u16 *) buf)[0] = letoh16(u.u16[(pos % 4) / 2]);
95 break;
96 case 4:
97 ((u32 *) buf)[0] = (u32) letoh32(pi.pi_data);
98 break;
99 }
100 return 1;
101 }
102
103 static int
obsd_write(struct pci_dev * d,int pos,byte * buf,int len)104 obsd_write(struct pci_dev *d, int pos, byte *buf, int len)
105 {
106 struct pci_io pi;
107
108 if (!(len == 1 || len == 2 || len == 4))
109 return pci_generic_block_write(d, pos, buf, len);
110
111 if (d->domain || pos >= 256)
112 return 0;
113
114 pi.pi_sel.pc_bus = d->bus;
115 pi.pi_sel.pc_dev = d->dev;
116 pi.pi_sel.pc_func = d->func;
117
118 pi.pi_reg = pos;
119 pi.pi_width = len;
120
121 switch (len)
122 {
123 case 1:
124 pi.pi_data = buf[0];
125 break;
126 case 2:
127 pi.pi_data = ((u16 *) buf)[0];
128 break;
129 case 4:
130 pi.pi_data = ((u32 *) buf)[0];
131 break;
132 }
133
134 if (ioctl(d->access->fd, PCIOCWRITE, &pi) < 0)
135 d->access->error("obsd_write: ioctl(PCIOCWRITE) failed");
136
137 return 1;
138 }
139
140 struct pci_methods pm_obsd_device = {
141 .name = "obsd-device",
142 .help = "/dev/pci on OpenBSD",
143 .config = obsd_config,
144 .detect = obsd_detect,
145 .init = obsd_init,
146 .cleanup = obsd_cleanup,
147 .scan = pci_generic_scan,
148 .fill_info = pci_generic_fill_info,
149 .read = obsd_read,
150 .write = obsd_write,
151 };
152