mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-10-06 16:49:22 +00:00
ipmi_si: Move port and mem I/O handling to their own files
Signed-off-by: Corey Minyard <cminyard@mvista.com>
This commit is contained in:
parent
d1a6791323
commit
58e2763553
5 changed files with 263 additions and 255 deletions
|
@ -3,7 +3,8 @@
|
||||||
#
|
#
|
||||||
|
|
||||||
ipmi_si-y := ipmi_si_intf.o ipmi_kcs_sm.o ipmi_smic_sm.o ipmi_bt_sm.o \
|
ipmi_si-y := ipmi_si_intf.o ipmi_kcs_sm.o ipmi_smic_sm.o ipmi_bt_sm.o \
|
||||||
ipmi_si_hotmod.o ipmi_si_hardcode.o ipmi_si_platform.o
|
ipmi_si_hotmod.o ipmi_si_hardcode.o ipmi_si_platform.o \
|
||||||
|
ipmi_si_port_io.o ipmi_si_mem_io.o
|
||||||
ifdef CONFIG_PCI
|
ifdef CONFIG_PCI
|
||||||
ipmi_si-y += ipmi_si_pci.o
|
ipmi_si-y += ipmi_si_pci.o
|
||||||
endif
|
endif
|
||||||
|
|
|
@ -44,3 +44,6 @@ void ipmi_si_parisc_shutdown(void);
|
||||||
static inline void ipmi_si_parisc_init(void) { }
|
static inline void ipmi_si_parisc_init(void) { }
|
||||||
static inline void ipmi_si_parisc_shutdown(void) { }
|
static inline void ipmi_si_parisc_shutdown(void) { }
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
int ipmi_si_port_setup(struct si_sm_io *io);
|
||||||
|
int ipmi_si_mem_setup(struct si_sm_io *io);
|
||||||
|
|
|
@ -49,7 +49,6 @@
|
||||||
#include <linux/slab.h>
|
#include <linux/slab.h>
|
||||||
#include <linux/delay.h>
|
#include <linux/delay.h>
|
||||||
#include <linux/list.h>
|
#include <linux/list.h>
|
||||||
#include <linux/ioport.h>
|
|
||||||
#include <linux/notifier.h>
|
#include <linux/notifier.h>
|
||||||
#include <linux/mutex.h>
|
#include <linux/mutex.h>
|
||||||
#include <linux/kthread.h>
|
#include <linux/kthread.h>
|
||||||
|
@ -58,7 +57,6 @@
|
||||||
#include <linux/rcupdate.h>
|
#include <linux/rcupdate.h>
|
||||||
#include <linux/ipmi.h>
|
#include <linux/ipmi.h>
|
||||||
#include <linux/ipmi_smi.h>
|
#include <linux/ipmi_smi.h>
|
||||||
#include <asm/io.h>
|
|
||||||
#include "ipmi_si.h"
|
#include "ipmi_si.h"
|
||||||
#include <linux/string.h>
|
#include <linux/string.h>
|
||||||
#include <linux/ctype.h>
|
#include <linux/ctype.h>
|
||||||
|
@ -1304,256 +1302,6 @@ int ipmi_std_irq_setup(struct si_sm_io *io)
|
||||||
return rv;
|
return rv;
|
||||||
}
|
}
|
||||||
|
|
||||||
static unsigned char port_inb(const struct si_sm_io *io, unsigned int offset)
|
|
||||||
{
|
|
||||||
unsigned int addr = io->addr_data;
|
|
||||||
|
|
||||||
return inb(addr + (offset * io->regspacing));
|
|
||||||
}
|
|
||||||
|
|
||||||
static void port_outb(const struct si_sm_io *io, unsigned int offset,
|
|
||||||
unsigned char b)
|
|
||||||
{
|
|
||||||
unsigned int addr = io->addr_data;
|
|
||||||
|
|
||||||
outb(b, addr + (offset * io->regspacing));
|
|
||||||
}
|
|
||||||
|
|
||||||
static unsigned char port_inw(const struct si_sm_io *io, unsigned int offset)
|
|
||||||
{
|
|
||||||
unsigned int addr = io->addr_data;
|
|
||||||
|
|
||||||
return (inw(addr + (offset * io->regspacing)) >> io->regshift) & 0xff;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void port_outw(const struct si_sm_io *io, unsigned int offset,
|
|
||||||
unsigned char b)
|
|
||||||
{
|
|
||||||
unsigned int addr = io->addr_data;
|
|
||||||
|
|
||||||
outw(b << io->regshift, addr + (offset * io->regspacing));
|
|
||||||
}
|
|
||||||
|
|
||||||
static unsigned char port_inl(const struct si_sm_io *io, unsigned int offset)
|
|
||||||
{
|
|
||||||
unsigned int addr = io->addr_data;
|
|
||||||
|
|
||||||
return (inl(addr + (offset * io->regspacing)) >> io->regshift) & 0xff;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void port_outl(const struct si_sm_io *io, unsigned int offset,
|
|
||||||
unsigned char b)
|
|
||||||
{
|
|
||||||
unsigned int addr = io->addr_data;
|
|
||||||
|
|
||||||
outl(b << io->regshift, addr+(offset * io->regspacing));
|
|
||||||
}
|
|
||||||
|
|
||||||
static void port_cleanup(struct si_sm_io *io)
|
|
||||||
{
|
|
||||||
unsigned int addr = io->addr_data;
|
|
||||||
int idx;
|
|
||||||
|
|
||||||
if (addr) {
|
|
||||||
for (idx = 0; idx < io->io_size; idx++)
|
|
||||||
release_region(addr + idx * io->regspacing,
|
|
||||||
io->regsize);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
static int port_setup(struct si_sm_io *io)
|
|
||||||
{
|
|
||||||
unsigned int addr = io->addr_data;
|
|
||||||
int idx;
|
|
||||||
|
|
||||||
if (!addr)
|
|
||||||
return -ENODEV;
|
|
||||||
|
|
||||||
io->io_cleanup = port_cleanup;
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Figure out the actual inb/inw/inl/etc routine to use based
|
|
||||||
* upon the register size.
|
|
||||||
*/
|
|
||||||
switch (io->regsize) {
|
|
||||||
case 1:
|
|
||||||
io->inputb = port_inb;
|
|
||||||
io->outputb = port_outb;
|
|
||||||
break;
|
|
||||||
case 2:
|
|
||||||
io->inputb = port_inw;
|
|
||||||
io->outputb = port_outw;
|
|
||||||
break;
|
|
||||||
case 4:
|
|
||||||
io->inputb = port_inl;
|
|
||||||
io->outputb = port_outl;
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
dev_warn(io->dev, "Invalid register size: %d\n",
|
|
||||||
io->regsize);
|
|
||||||
return -EINVAL;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Some BIOSes reserve disjoint I/O regions in their ACPI
|
|
||||||
* tables. This causes problems when trying to register the
|
|
||||||
* entire I/O region. Therefore we must register each I/O
|
|
||||||
* port separately.
|
|
||||||
*/
|
|
||||||
for (idx = 0; idx < io->io_size; idx++) {
|
|
||||||
if (request_region(addr + idx * io->regspacing,
|
|
||||||
io->regsize, DEVICE_NAME) == NULL) {
|
|
||||||
/* Undo allocations */
|
|
||||||
while (idx--)
|
|
||||||
release_region(addr + idx * io->regspacing,
|
|
||||||
io->regsize);
|
|
||||||
return -EIO;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static unsigned char intf_mem_inb(const struct si_sm_io *io,
|
|
||||||
unsigned int offset)
|
|
||||||
{
|
|
||||||
return readb((io->addr)+(offset * io->regspacing));
|
|
||||||
}
|
|
||||||
|
|
||||||
static void intf_mem_outb(const struct si_sm_io *io, unsigned int offset,
|
|
||||||
unsigned char b)
|
|
||||||
{
|
|
||||||
writeb(b, (io->addr)+(offset * io->regspacing));
|
|
||||||
}
|
|
||||||
|
|
||||||
static unsigned char intf_mem_inw(const struct si_sm_io *io,
|
|
||||||
unsigned int offset)
|
|
||||||
{
|
|
||||||
return (readw((io->addr)+(offset * io->regspacing)) >> io->regshift)
|
|
||||||
& 0xff;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void intf_mem_outw(const struct si_sm_io *io, unsigned int offset,
|
|
||||||
unsigned char b)
|
|
||||||
{
|
|
||||||
writeb(b << io->regshift, (io->addr)+(offset * io->regspacing));
|
|
||||||
}
|
|
||||||
|
|
||||||
static unsigned char intf_mem_inl(const struct si_sm_io *io,
|
|
||||||
unsigned int offset)
|
|
||||||
{
|
|
||||||
return (readl((io->addr)+(offset * io->regspacing)) >> io->regshift)
|
|
||||||
& 0xff;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void intf_mem_outl(const struct si_sm_io *io, unsigned int offset,
|
|
||||||
unsigned char b)
|
|
||||||
{
|
|
||||||
writel(b << io->regshift, (io->addr)+(offset * io->regspacing));
|
|
||||||
}
|
|
||||||
|
|
||||||
#ifdef readq
|
|
||||||
static unsigned char mem_inq(const struct si_sm_io *io, unsigned int offset)
|
|
||||||
{
|
|
||||||
return (readq((io->addr)+(offset * io->regspacing)) >> io->regshift)
|
|
||||||
& 0xff;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void mem_outq(const struct si_sm_io *io, unsigned int offset,
|
|
||||||
unsigned char b)
|
|
||||||
{
|
|
||||||
writeq(b << io->regshift, (io->addr)+(offset * io->regspacing));
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
|
|
||||||
static void mem_region_cleanup(struct si_sm_io *io, int num)
|
|
||||||
{
|
|
||||||
unsigned long addr = io->addr_data;
|
|
||||||
int idx;
|
|
||||||
|
|
||||||
for (idx = 0; idx < num; idx++)
|
|
||||||
release_mem_region(addr + idx * io->regspacing,
|
|
||||||
io->regsize);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void mem_cleanup(struct si_sm_io *io)
|
|
||||||
{
|
|
||||||
if (io->addr) {
|
|
||||||
iounmap(io->addr);
|
|
||||||
mem_region_cleanup(io, io->io_size);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
static int mem_setup(struct si_sm_io *io)
|
|
||||||
{
|
|
||||||
unsigned long addr = io->addr_data;
|
|
||||||
int mapsize, idx;
|
|
||||||
|
|
||||||
if (!addr)
|
|
||||||
return -ENODEV;
|
|
||||||
|
|
||||||
io->io_cleanup = mem_cleanup;
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Figure out the actual readb/readw/readl/etc routine to use based
|
|
||||||
* upon the register size.
|
|
||||||
*/
|
|
||||||
switch (io->regsize) {
|
|
||||||
case 1:
|
|
||||||
io->inputb = intf_mem_inb;
|
|
||||||
io->outputb = intf_mem_outb;
|
|
||||||
break;
|
|
||||||
case 2:
|
|
||||||
io->inputb = intf_mem_inw;
|
|
||||||
io->outputb = intf_mem_outw;
|
|
||||||
break;
|
|
||||||
case 4:
|
|
||||||
io->inputb = intf_mem_inl;
|
|
||||||
io->outputb = intf_mem_outl;
|
|
||||||
break;
|
|
||||||
#ifdef readq
|
|
||||||
case 8:
|
|
||||||
io->inputb = mem_inq;
|
|
||||||
io->outputb = mem_outq;
|
|
||||||
break;
|
|
||||||
#endif
|
|
||||||
default:
|
|
||||||
dev_warn(io->dev, "Invalid register size: %d\n",
|
|
||||||
io->regsize);
|
|
||||||
return -EINVAL;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Some BIOSes reserve disjoint memory regions in their ACPI
|
|
||||||
* tables. This causes problems when trying to request the
|
|
||||||
* entire region. Therefore we must request each register
|
|
||||||
* separately.
|
|
||||||
*/
|
|
||||||
for (idx = 0; idx < io->io_size; idx++) {
|
|
||||||
if (request_mem_region(addr + idx * io->regspacing,
|
|
||||||
io->regsize, DEVICE_NAME) == NULL) {
|
|
||||||
/* Undo allocations */
|
|
||||||
mem_region_cleanup(io, idx);
|
|
||||||
return -EIO;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Calculate the total amount of memory to claim. This is an
|
|
||||||
* unusual looking calculation, but it avoids claiming any
|
|
||||||
* more memory than it has to. It will claim everything
|
|
||||||
* between the first address to the end of the last full
|
|
||||||
* register.
|
|
||||||
*/
|
|
||||||
mapsize = ((io->io_size * io->regspacing)
|
|
||||||
- (io->regspacing - io->regsize));
|
|
||||||
io->addr = ioremap(addr, mapsize);
|
|
||||||
if (io->addr == NULL) {
|
|
||||||
mem_region_cleanup(io, io->io_size);
|
|
||||||
return -EIO;
|
|
||||||
}
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static struct smi_info *smi_info_alloc(void)
|
static struct smi_info *smi_info_alloc(void)
|
||||||
{
|
{
|
||||||
struct smi_info *info = kzalloc(sizeof(*info), GFP_KERNEL);
|
struct smi_info *info = kzalloc(sizeof(*info), GFP_KERNEL);
|
||||||
|
@ -2146,9 +1894,9 @@ int ipmi_si_add_smi(struct si_sm_io *io)
|
||||||
|
|
||||||
if (!io->io_setup) {
|
if (!io->io_setup) {
|
||||||
if (io->addr_type == IPMI_IO_ADDR_SPACE) {
|
if (io->addr_type == IPMI_IO_ADDR_SPACE) {
|
||||||
io->io_setup = port_setup;
|
io->io_setup = ipmi_si_port_setup;
|
||||||
} else if (io->addr_type == IPMI_MEM_ADDR_SPACE) {
|
} else if (io->addr_type == IPMI_MEM_ADDR_SPACE) {
|
||||||
io->io_setup = mem_setup;
|
io->io_setup = ipmi_si_mem_setup;
|
||||||
} else {
|
} else {
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
}
|
}
|
||||||
|
|
144
drivers/char/ipmi/ipmi_si_mem_io.c
Normal file
144
drivers/char/ipmi/ipmi_si_mem_io.c
Normal file
|
@ -0,0 +1,144 @@
|
||||||
|
|
||||||
|
#include <linux/io.h>
|
||||||
|
#include "ipmi_si.h"
|
||||||
|
|
||||||
|
static unsigned char intf_mem_inb(const struct si_sm_io *io,
|
||||||
|
unsigned int offset)
|
||||||
|
{
|
||||||
|
return readb((io->addr)+(offset * io->regspacing));
|
||||||
|
}
|
||||||
|
|
||||||
|
static void intf_mem_outb(const struct si_sm_io *io, unsigned int offset,
|
||||||
|
unsigned char b)
|
||||||
|
{
|
||||||
|
writeb(b, (io->addr)+(offset * io->regspacing));
|
||||||
|
}
|
||||||
|
|
||||||
|
static unsigned char intf_mem_inw(const struct si_sm_io *io,
|
||||||
|
unsigned int offset)
|
||||||
|
{
|
||||||
|
return (readw((io->addr)+(offset * io->regspacing)) >> io->regshift)
|
||||||
|
& 0xff;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void intf_mem_outw(const struct si_sm_io *io, unsigned int offset,
|
||||||
|
unsigned char b)
|
||||||
|
{
|
||||||
|
writeb(b << io->regshift, (io->addr)+(offset * io->regspacing));
|
||||||
|
}
|
||||||
|
|
||||||
|
static unsigned char intf_mem_inl(const struct si_sm_io *io,
|
||||||
|
unsigned int offset)
|
||||||
|
{
|
||||||
|
return (readl((io->addr)+(offset * io->regspacing)) >> io->regshift)
|
||||||
|
& 0xff;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void intf_mem_outl(const struct si_sm_io *io, unsigned int offset,
|
||||||
|
unsigned char b)
|
||||||
|
{
|
||||||
|
writel(b << io->regshift, (io->addr)+(offset * io->regspacing));
|
||||||
|
}
|
||||||
|
|
||||||
|
#ifdef readq
|
||||||
|
static unsigned char mem_inq(const struct si_sm_io *io, unsigned int offset)
|
||||||
|
{
|
||||||
|
return (readq((io->addr)+(offset * io->regspacing)) >> io->regshift)
|
||||||
|
& 0xff;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void mem_outq(const struct si_sm_io *io, unsigned int offset,
|
||||||
|
unsigned char b)
|
||||||
|
{
|
||||||
|
writeq(b << io->regshift, (io->addr)+(offset * io->regspacing));
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
static void mem_region_cleanup(struct si_sm_io *io, int num)
|
||||||
|
{
|
||||||
|
unsigned long addr = io->addr_data;
|
||||||
|
int idx;
|
||||||
|
|
||||||
|
for (idx = 0; idx < num; idx++)
|
||||||
|
release_mem_region(addr + idx * io->regspacing,
|
||||||
|
io->regsize);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void mem_cleanup(struct si_sm_io *io)
|
||||||
|
{
|
||||||
|
if (io->addr) {
|
||||||
|
iounmap(io->addr);
|
||||||
|
mem_region_cleanup(io, io->io_size);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
int ipmi_si_mem_setup(struct si_sm_io *io)
|
||||||
|
{
|
||||||
|
unsigned long addr = io->addr_data;
|
||||||
|
int mapsize, idx;
|
||||||
|
|
||||||
|
if (!addr)
|
||||||
|
return -ENODEV;
|
||||||
|
|
||||||
|
io->io_cleanup = mem_cleanup;
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Figure out the actual readb/readw/readl/etc routine to use based
|
||||||
|
* upon the register size.
|
||||||
|
*/
|
||||||
|
switch (io->regsize) {
|
||||||
|
case 1:
|
||||||
|
io->inputb = intf_mem_inb;
|
||||||
|
io->outputb = intf_mem_outb;
|
||||||
|
break;
|
||||||
|
case 2:
|
||||||
|
io->inputb = intf_mem_inw;
|
||||||
|
io->outputb = intf_mem_outw;
|
||||||
|
break;
|
||||||
|
case 4:
|
||||||
|
io->inputb = intf_mem_inl;
|
||||||
|
io->outputb = intf_mem_outl;
|
||||||
|
break;
|
||||||
|
#ifdef readq
|
||||||
|
case 8:
|
||||||
|
io->inputb = mem_inq;
|
||||||
|
io->outputb = mem_outq;
|
||||||
|
break;
|
||||||
|
#endif
|
||||||
|
default:
|
||||||
|
dev_warn(io->dev, "Invalid register size: %d\n",
|
||||||
|
io->regsize);
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Some BIOSes reserve disjoint memory regions in their ACPI
|
||||||
|
* tables. This causes problems when trying to request the
|
||||||
|
* entire region. Therefore we must request each register
|
||||||
|
* separately.
|
||||||
|
*/
|
||||||
|
for (idx = 0; idx < io->io_size; idx++) {
|
||||||
|
if (request_mem_region(addr + idx * io->regspacing,
|
||||||
|
io->regsize, DEVICE_NAME) == NULL) {
|
||||||
|
/* Undo allocations */
|
||||||
|
mem_region_cleanup(io, idx);
|
||||||
|
return -EIO;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Calculate the total amount of memory to claim. This is an
|
||||||
|
* unusual looking calculation, but it avoids claiming any
|
||||||
|
* more memory than it has to. It will claim everything
|
||||||
|
* between the first address to the end of the last full
|
||||||
|
* register.
|
||||||
|
*/
|
||||||
|
mapsize = ((io->io_size * io->regspacing)
|
||||||
|
- (io->regspacing - io->regsize));
|
||||||
|
io->addr = ioremap(addr, mapsize);
|
||||||
|
if (io->addr == NULL) {
|
||||||
|
mem_region_cleanup(io, io->io_size);
|
||||||
|
return -EIO;
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
}
|
112
drivers/char/ipmi/ipmi_si_port_io.c
Normal file
112
drivers/char/ipmi/ipmi_si_port_io.c
Normal file
|
@ -0,0 +1,112 @@
|
||||||
|
|
||||||
|
#include <linux/io.h>
|
||||||
|
#include "ipmi_si.h"
|
||||||
|
|
||||||
|
static unsigned char port_inb(const struct si_sm_io *io, unsigned int offset)
|
||||||
|
{
|
||||||
|
unsigned int addr = io->addr_data;
|
||||||
|
|
||||||
|
return inb(addr + (offset * io->regspacing));
|
||||||
|
}
|
||||||
|
|
||||||
|
static void port_outb(const struct si_sm_io *io, unsigned int offset,
|
||||||
|
unsigned char b)
|
||||||
|
{
|
||||||
|
unsigned int addr = io->addr_data;
|
||||||
|
|
||||||
|
outb(b, addr + (offset * io->regspacing));
|
||||||
|
}
|
||||||
|
|
||||||
|
static unsigned char port_inw(const struct si_sm_io *io, unsigned int offset)
|
||||||
|
{
|
||||||
|
unsigned int addr = io->addr_data;
|
||||||
|
|
||||||
|
return (inw(addr + (offset * io->regspacing)) >> io->regshift) & 0xff;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void port_outw(const struct si_sm_io *io, unsigned int offset,
|
||||||
|
unsigned char b)
|
||||||
|
{
|
||||||
|
unsigned int addr = io->addr_data;
|
||||||
|
|
||||||
|
outw(b << io->regshift, addr + (offset * io->regspacing));
|
||||||
|
}
|
||||||
|
|
||||||
|
static unsigned char port_inl(const struct si_sm_io *io, unsigned int offset)
|
||||||
|
{
|
||||||
|
unsigned int addr = io->addr_data;
|
||||||
|
|
||||||
|
return (inl(addr + (offset * io->regspacing)) >> io->regshift) & 0xff;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void port_outl(const struct si_sm_io *io, unsigned int offset,
|
||||||
|
unsigned char b)
|
||||||
|
{
|
||||||
|
unsigned int addr = io->addr_data;
|
||||||
|
|
||||||
|
outl(b << io->regshift, addr+(offset * io->regspacing));
|
||||||
|
}
|
||||||
|
|
||||||
|
static void port_cleanup(struct si_sm_io *io)
|
||||||
|
{
|
||||||
|
unsigned int addr = io->addr_data;
|
||||||
|
int idx;
|
||||||
|
|
||||||
|
if (addr) {
|
||||||
|
for (idx = 0; idx < io->io_size; idx++)
|
||||||
|
release_region(addr + idx * io->regspacing,
|
||||||
|
io->regsize);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
int ipmi_si_port_setup(struct si_sm_io *io)
|
||||||
|
{
|
||||||
|
unsigned int addr = io->addr_data;
|
||||||
|
int idx;
|
||||||
|
|
||||||
|
if (!addr)
|
||||||
|
return -ENODEV;
|
||||||
|
|
||||||
|
io->io_cleanup = port_cleanup;
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Figure out the actual inb/inw/inl/etc routine to use based
|
||||||
|
* upon the register size.
|
||||||
|
*/
|
||||||
|
switch (io->regsize) {
|
||||||
|
case 1:
|
||||||
|
io->inputb = port_inb;
|
||||||
|
io->outputb = port_outb;
|
||||||
|
break;
|
||||||
|
case 2:
|
||||||
|
io->inputb = port_inw;
|
||||||
|
io->outputb = port_outw;
|
||||||
|
break;
|
||||||
|
case 4:
|
||||||
|
io->inputb = port_inl;
|
||||||
|
io->outputb = port_outl;
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
dev_warn(io->dev, "Invalid register size: %d\n",
|
||||||
|
io->regsize);
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Some BIOSes reserve disjoint I/O regions in their ACPI
|
||||||
|
* tables. This causes problems when trying to register the
|
||||||
|
* entire I/O region. Therefore we must register each I/O
|
||||||
|
* port separately.
|
||||||
|
*/
|
||||||
|
for (idx = 0; idx < io->io_size; idx++) {
|
||||||
|
if (request_region(addr + idx * io->regspacing,
|
||||||
|
io->regsize, DEVICE_NAME) == NULL) {
|
||||||
|
/* Undo allocations */
|
||||||
|
while (idx--)
|
||||||
|
release_region(addr + idx * io->regspacing,
|
||||||
|
io->regsize);
|
||||||
|
return -EIO;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
}
|
Loading…
Reference in a new issue