Commit | Line | Data |
---|---|---|
243ac210 | 1 | // SPDX-License-Identifier: GPL-2.0+ |
58e27635 CM |
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 | ||
58e27635 CM |
71 | /* |
72 | * Figure out the actual inb/inw/inl/etc routine to use based | |
73 | * upon the register size. | |
74 | */ | |
75 | switch (io->regsize) { | |
76 | case 1: | |
77 | io->inputb = port_inb; | |
78 | io->outputb = port_outb; | |
79 | break; | |
80 | case 2: | |
81 | io->inputb = port_inw; | |
82 | io->outputb = port_outw; | |
83 | break; | |
84 | case 4: | |
85 | io->inputb = port_inl; | |
86 | io->outputb = port_outl; | |
87 | break; | |
88 | default: | |
89 | dev_warn(io->dev, "Invalid register size: %d\n", | |
90 | io->regsize); | |
91 | return -EINVAL; | |
92 | } | |
93 | ||
94 | /* | |
95 | * Some BIOSes reserve disjoint I/O regions in their ACPI | |
96 | * tables. This causes problems when trying to register the | |
97 | * entire I/O region. Therefore we must register each I/O | |
98 | * port separately. | |
99 | */ | |
100 | for (idx = 0; idx < io->io_size; idx++) { | |
101 | if (request_region(addr + idx * io->regspacing, | |
104fb25f | 102 | io->regsize, SI_DEVICE_NAME) == NULL) { |
58e27635 CM |
103 | /* Undo allocations */ |
104 | while (idx--) | |
105 | release_region(addr + idx * io->regspacing, | |
106 | io->regsize); | |
107 | return -EIO; | |
108 | } | |
109 | } | |
401e7e88 YY |
110 | |
111 | io->io_cleanup = port_cleanup; | |
112 | ||
58e27635 CM |
113 | return 0; |
114 | } |