1 // SPDX-License-Identifier: GPL-2.0+ 2 3 #include <linux/io.h> 4 #include "ipmi_si.h" 5 6 static unsigned char port_inb(const struct si_sm_io *io, unsigned int offset) 7 { 8 unsigned int addr = io->addr_data; 9 10 return inb(addr + (offset * io->regspacing)); 11 } 12 13 static void port_outb(const struct si_sm_io *io, unsigned int offset, 14 unsigned char b) 15 { 16 unsigned int addr = io->addr_data; 17 18 outb(b, addr + (offset * io->regspacing)); 19 } 20 21 static unsigned char port_inw(const struct si_sm_io *io, unsigned int offset) 22 { 23 unsigned int addr = io->addr_data; 24 25 return (inw(addr + (offset * io->regspacing)) >> io->regshift) & 0xff; 26 } 27 28 static void port_outw(const struct si_sm_io *io, unsigned int offset, 29 unsigned char b) 30 { 31 unsigned int addr = io->addr_data; 32 33 outw(b << io->regshift, addr + (offset * io->regspacing)); 34 } 35 36 static unsigned char port_inl(const struct si_sm_io *io, unsigned int offset) 37 { 38 unsigned int addr = io->addr_data; 39 40 return (inl(addr + (offset * io->regspacing)) >> io->regshift) & 0xff; 41 } 42 43 static void port_outl(const struct si_sm_io *io, unsigned int offset, 44 unsigned char b) 45 { 46 unsigned int addr = io->addr_data; 47 48 outl(b << io->regshift, addr+(offset * io->regspacing)); 49 } 50 51 static void port_cleanup(struct si_sm_io *io) 52 { 53 unsigned int addr = io->addr_data; 54 int idx; 55 56 if (addr) { 57 for (idx = 0; idx < io->io_size; idx++) 58 release_region(addr + idx * io->regspacing, 59 io->regsize); 60 } 61 } 62 63 int ipmi_si_port_setup(struct si_sm_io *io) 64 { 65 unsigned int addr = io->addr_data; 66 int idx; 67 68 if (!addr) 69 return -ENODEV; 70 71 io->io_cleanup = port_cleanup; 72 73 /* 74 * Figure out the actual inb/inw/inl/etc routine to use based 75 * upon the register size. 76 */ 77 switch (io->regsize) { 78 case 1: 79 io->inputb = port_inb; 80 io->outputb = port_outb; 81 break; 82 case 2: 83 io->inputb = port_inw; 84 io->outputb = port_outw; 85 break; 86 case 4: 87 io->inputb = port_inl; 88 io->outputb = port_outl; 89 break; 90 default: 91 dev_warn(io->dev, "Invalid register size: %d\n", 92 io->regsize); 93 return -EINVAL; 94 } 95 96 /* 97 * Some BIOSes reserve disjoint I/O regions in their ACPI 98 * tables. This causes problems when trying to register the 99 * entire I/O region. Therefore we must register each I/O 100 * port separately. 101 */ 102 for (idx = 0; idx < io->io_size; idx++) { 103 if (request_region(addr + idx * io->regspacing, 104 io->regsize, DEVICE_NAME) == NULL) { 105 /* Undo allocations */ 106 while (idx--) 107 release_region(addr + idx * io->regspacing, 108 io->regsize); 109 return -EIO; 110 } 111 } 112 return 0; 113 } 114