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 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 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 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 52 obsd_cleanup(struct pci_access *a) 53 { 54 close(a->fd); 55 } 56 57 static int 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 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 "obsd-device", 142 "/dev/pci on OpenBSD", 143 obsd_config, 144 obsd_detect, 145 obsd_init, 146 obsd_cleanup, 147 pci_generic_scan, 148 pci_generic_fill_info, 149 obsd_read, 150 obsd_write, 151 NULL, /* read_vpd */ 152 NULL, /* dev_init */ 153 NULL /* dev_cleanup */ 154 }; 155