drivers/char/ipmi/ipmi_si_port_io.c

   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 }