xref: /aosp_15_r20/external/pciutils/lib/i386-ports.c (revision c2e0c6b56a71da9abe8df5c8348fb3eb5c2c9251)
1*c2e0c6b5SAndroid Build Coastguard Worker /*
2*c2e0c6b5SAndroid Build Coastguard Worker  *	The PCI Library -- Direct Configuration access via i386 Ports
3*c2e0c6b5SAndroid Build Coastguard Worker  *
4*c2e0c6b5SAndroid Build Coastguard Worker  *	Copyright (c) 1997--2006 Martin Mares <[email protected]>
5*c2e0c6b5SAndroid Build Coastguard Worker  *
6*c2e0c6b5SAndroid Build Coastguard Worker  *	Can be freely distributed and used under the terms of the GNU GPL v2+.
7*c2e0c6b5SAndroid Build Coastguard Worker  *
8*c2e0c6b5SAndroid Build Coastguard Worker  *	SPDX-License-Identifier: GPL-2.0-or-later
9*c2e0c6b5SAndroid Build Coastguard Worker  */
10*c2e0c6b5SAndroid Build Coastguard Worker 
11*c2e0c6b5SAndroid Build Coastguard Worker #define _GNU_SOURCE
12*c2e0c6b5SAndroid Build Coastguard Worker 
13*c2e0c6b5SAndroid Build Coastguard Worker #include "internal.h"
14*c2e0c6b5SAndroid Build Coastguard Worker 
15*c2e0c6b5SAndroid Build Coastguard Worker #include <string.h>
16*c2e0c6b5SAndroid Build Coastguard Worker 
17*c2e0c6b5SAndroid Build Coastguard Worker #if defined(PCI_OS_LINUX)
18*c2e0c6b5SAndroid Build Coastguard Worker #include "i386-io-linux.h"
19*c2e0c6b5SAndroid Build Coastguard Worker #elif defined(PCI_OS_GNU)
20*c2e0c6b5SAndroid Build Coastguard Worker #include "i386-io-hurd.h"
21*c2e0c6b5SAndroid Build Coastguard Worker #elif defined(PCI_OS_SUNOS)
22*c2e0c6b5SAndroid Build Coastguard Worker #include "i386-io-sunos.h"
23*c2e0c6b5SAndroid Build Coastguard Worker #elif defined(PCI_OS_WINDOWS)
24*c2e0c6b5SAndroid Build Coastguard Worker #include "i386-io-windows.h"
25*c2e0c6b5SAndroid Build Coastguard Worker #elif defined(PCI_OS_CYGWIN)
26*c2e0c6b5SAndroid Build Coastguard Worker #include "i386-io-cygwin.h"
27*c2e0c6b5SAndroid Build Coastguard Worker #elif defined(PCI_OS_HAIKU)
28*c2e0c6b5SAndroid Build Coastguard Worker #include "i386-io-haiku.h"
29*c2e0c6b5SAndroid Build Coastguard Worker #elif defined(PCI_OS_BEOS)
30*c2e0c6b5SAndroid Build Coastguard Worker #include "i386-io-beos.h"
31*c2e0c6b5SAndroid Build Coastguard Worker #elif defined(PCI_OS_DJGPP)
32*c2e0c6b5SAndroid Build Coastguard Worker #include "i386-io-djgpp.h"
33*c2e0c6b5SAndroid Build Coastguard Worker #elif defined(PCI_OS_OPENBSD)
34*c2e0c6b5SAndroid Build Coastguard Worker #include "i386-io-openbsd.h"
35*c2e0c6b5SAndroid Build Coastguard Worker #else
36*c2e0c6b5SAndroid Build Coastguard Worker #error Do not know how to access I/O ports on this OS.
37*c2e0c6b5SAndroid Build Coastguard Worker #endif
38*c2e0c6b5SAndroid Build Coastguard Worker 
39*c2e0c6b5SAndroid Build Coastguard Worker static int conf12_io_enabled = -1;		/* -1=haven't tried, 0=failed, 1=succeeded */
40*c2e0c6b5SAndroid Build Coastguard Worker 
41*c2e0c6b5SAndroid Build Coastguard Worker static int
conf12_setup_io(struct pci_access * a)42*c2e0c6b5SAndroid Build Coastguard Worker conf12_setup_io(struct pci_access *a)
43*c2e0c6b5SAndroid Build Coastguard Worker {
44*c2e0c6b5SAndroid Build Coastguard Worker   if (conf12_io_enabled < 0)
45*c2e0c6b5SAndroid Build Coastguard Worker     conf12_io_enabled = intel_setup_io(a);
46*c2e0c6b5SAndroid Build Coastguard Worker   return conf12_io_enabled;
47*c2e0c6b5SAndroid Build Coastguard Worker }
48*c2e0c6b5SAndroid Build Coastguard Worker 
49*c2e0c6b5SAndroid Build Coastguard Worker static void
conf12_init(struct pci_access * a)50*c2e0c6b5SAndroid Build Coastguard Worker conf12_init(struct pci_access *a)
51*c2e0c6b5SAndroid Build Coastguard Worker {
52*c2e0c6b5SAndroid Build Coastguard Worker   if (!conf12_setup_io(a))
53*c2e0c6b5SAndroid Build Coastguard Worker     a->error("No permission to access I/O ports (you probably have to be root).");
54*c2e0c6b5SAndroid Build Coastguard Worker }
55*c2e0c6b5SAndroid Build Coastguard Worker 
56*c2e0c6b5SAndroid Build Coastguard Worker static void
conf12_cleanup(struct pci_access * a)57*c2e0c6b5SAndroid Build Coastguard Worker conf12_cleanup(struct pci_access *a)
58*c2e0c6b5SAndroid Build Coastguard Worker {
59*c2e0c6b5SAndroid Build Coastguard Worker   if (conf12_io_enabled > 0)
60*c2e0c6b5SAndroid Build Coastguard Worker     {
61*c2e0c6b5SAndroid Build Coastguard Worker       intel_cleanup_io(a);
62*c2e0c6b5SAndroid Build Coastguard Worker       conf12_io_enabled = -1;
63*c2e0c6b5SAndroid Build Coastguard Worker     }
64*c2e0c6b5SAndroid Build Coastguard Worker }
65*c2e0c6b5SAndroid Build Coastguard Worker 
66*c2e0c6b5SAndroid Build Coastguard Worker /*
67*c2e0c6b5SAndroid Build Coastguard Worker  * Before we decide to use direct hardware access mechanisms, we try to do some
68*c2e0c6b5SAndroid Build Coastguard Worker  * trivial checks to ensure it at least _seems_ to be working -- we just test
69*c2e0c6b5SAndroid Build Coastguard Worker  * whether bus 00 contains a host bridge (this is similar to checking
70*c2e0c6b5SAndroid Build Coastguard Worker  * techniques used in XFree86, but ours should be more reliable since we
71*c2e0c6b5SAndroid Build Coastguard Worker  * attempt to make use of direct access hints provided by the PCI BIOS).
72*c2e0c6b5SAndroid Build Coastguard Worker  *
73*c2e0c6b5SAndroid Build Coastguard Worker  * This should be close to trivial, but it isn't, because there are buggy
74*c2e0c6b5SAndroid Build Coastguard Worker  * chipsets (yes, you guessed it, by Intel and Compaq) that have no class ID.
75*c2e0c6b5SAndroid Build Coastguard Worker  */
76*c2e0c6b5SAndroid Build Coastguard Worker 
77*c2e0c6b5SAndroid Build Coastguard Worker static int
intel_sanity_check(struct pci_access * a,struct pci_methods * m)78*c2e0c6b5SAndroid Build Coastguard Worker intel_sanity_check(struct pci_access *a, struct pci_methods *m)
79*c2e0c6b5SAndroid Build Coastguard Worker {
80*c2e0c6b5SAndroid Build Coastguard Worker   struct pci_dev d;
81*c2e0c6b5SAndroid Build Coastguard Worker 
82*c2e0c6b5SAndroid Build Coastguard Worker   memset(&d, 0, sizeof(d));
83*c2e0c6b5SAndroid Build Coastguard Worker   a->debug("...sanity check");
84*c2e0c6b5SAndroid Build Coastguard Worker   d.bus = 0;
85*c2e0c6b5SAndroid Build Coastguard Worker   d.func = 0;
86*c2e0c6b5SAndroid Build Coastguard Worker   for (d.dev = 0; d.dev < 32; d.dev++)
87*c2e0c6b5SAndroid Build Coastguard Worker     {
88*c2e0c6b5SAndroid Build Coastguard Worker       u16 class, vendor;
89*c2e0c6b5SAndroid Build Coastguard Worker       if (m->read(&d, PCI_CLASS_DEVICE, (byte *) &class, sizeof(class)) &&
90*c2e0c6b5SAndroid Build Coastguard Worker 	  (class == cpu_to_le16(PCI_CLASS_BRIDGE_HOST) || class == cpu_to_le16(PCI_CLASS_DISPLAY_VGA)) ||
91*c2e0c6b5SAndroid Build Coastguard Worker 	  m->read(&d, PCI_VENDOR_ID, (byte *) &vendor, sizeof(vendor)) &&
92*c2e0c6b5SAndroid Build Coastguard Worker 	  (vendor == cpu_to_le16(PCI_VENDOR_ID_INTEL) || vendor == cpu_to_le16(PCI_VENDOR_ID_COMPAQ)))
93*c2e0c6b5SAndroid Build Coastguard Worker 	{
94*c2e0c6b5SAndroid Build Coastguard Worker 	  a->debug("...outside the Asylum at 0/%02x/0", d.dev);
95*c2e0c6b5SAndroid Build Coastguard Worker 	  return 1;
96*c2e0c6b5SAndroid Build Coastguard Worker 	}
97*c2e0c6b5SAndroid Build Coastguard Worker     }
98*c2e0c6b5SAndroid Build Coastguard Worker   a->debug("...insane");
99*c2e0c6b5SAndroid Build Coastguard Worker   return 0;
100*c2e0c6b5SAndroid Build Coastguard Worker }
101*c2e0c6b5SAndroid Build Coastguard Worker 
102*c2e0c6b5SAndroid Build Coastguard Worker /*
103*c2e0c6b5SAndroid Build Coastguard Worker  *	Configuration type 1
104*c2e0c6b5SAndroid Build Coastguard Worker  */
105*c2e0c6b5SAndroid Build Coastguard Worker 
106*c2e0c6b5SAndroid Build Coastguard Worker #define CONFIG_CMD(bus, device_fn, where)   (0x80000000 | (bus << 16) | (device_fn << 8) | (where & ~3))
107*c2e0c6b5SAndroid Build Coastguard Worker 
108*c2e0c6b5SAndroid Build Coastguard Worker static int
conf1_detect(struct pci_access * a)109*c2e0c6b5SAndroid Build Coastguard Worker conf1_detect(struct pci_access *a)
110*c2e0c6b5SAndroid Build Coastguard Worker {
111*c2e0c6b5SAndroid Build Coastguard Worker   unsigned int tmp;
112*c2e0c6b5SAndroid Build Coastguard Worker   int res = 0;
113*c2e0c6b5SAndroid Build Coastguard Worker 
114*c2e0c6b5SAndroid Build Coastguard Worker   if (!conf12_setup_io(a))
115*c2e0c6b5SAndroid Build Coastguard Worker     {
116*c2e0c6b5SAndroid Build Coastguard Worker       a->debug("...no I/O permission");
117*c2e0c6b5SAndroid Build Coastguard Worker       return 0;
118*c2e0c6b5SAndroid Build Coastguard Worker     }
119*c2e0c6b5SAndroid Build Coastguard Worker 
120*c2e0c6b5SAndroid Build Coastguard Worker   intel_io_lock();
121*c2e0c6b5SAndroid Build Coastguard Worker   intel_outb (0x01, 0xCFB);
122*c2e0c6b5SAndroid Build Coastguard Worker   tmp = intel_inl (0xCF8);
123*c2e0c6b5SAndroid Build Coastguard Worker   intel_outl (0x80000000, 0xCF8);
124*c2e0c6b5SAndroid Build Coastguard Worker   if (intel_inl (0xCF8) == 0x80000000)
125*c2e0c6b5SAndroid Build Coastguard Worker     res = 1;
126*c2e0c6b5SAndroid Build Coastguard Worker   intel_outl (tmp, 0xCF8);
127*c2e0c6b5SAndroid Build Coastguard Worker   intel_io_unlock();
128*c2e0c6b5SAndroid Build Coastguard Worker 
129*c2e0c6b5SAndroid Build Coastguard Worker   if (res)
130*c2e0c6b5SAndroid Build Coastguard Worker     res = intel_sanity_check(a, &pm_intel_conf1);
131*c2e0c6b5SAndroid Build Coastguard Worker   return res;
132*c2e0c6b5SAndroid Build Coastguard Worker }
133*c2e0c6b5SAndroid Build Coastguard Worker 
134*c2e0c6b5SAndroid Build Coastguard Worker static int
conf1_read(struct pci_dev * d,int pos,byte * buf,int len)135*c2e0c6b5SAndroid Build Coastguard Worker conf1_read(struct pci_dev *d, int pos, byte *buf, int len)
136*c2e0c6b5SAndroid Build Coastguard Worker {
137*c2e0c6b5SAndroid Build Coastguard Worker   int addr = 0xcfc + (pos&3);
138*c2e0c6b5SAndroid Build Coastguard Worker   int res = 1;
139*c2e0c6b5SAndroid Build Coastguard Worker 
140*c2e0c6b5SAndroid Build Coastguard Worker   if (d->domain || pos >= 256)
141*c2e0c6b5SAndroid Build Coastguard Worker     return 0;
142*c2e0c6b5SAndroid Build Coastguard Worker 
143*c2e0c6b5SAndroid Build Coastguard Worker   if (len != 1 && len != 2 && len != 4)
144*c2e0c6b5SAndroid Build Coastguard Worker     return pci_generic_block_read(d, pos, buf, len);
145*c2e0c6b5SAndroid Build Coastguard Worker 
146*c2e0c6b5SAndroid Build Coastguard Worker   intel_io_lock();
147*c2e0c6b5SAndroid Build Coastguard Worker   intel_outl(0x80000000 | ((d->bus & 0xff) << 16) | (PCI_DEVFN(d->dev, d->func) << 8) | (pos&~3), 0xcf8);
148*c2e0c6b5SAndroid Build Coastguard Worker 
149*c2e0c6b5SAndroid Build Coastguard Worker   switch (len)
150*c2e0c6b5SAndroid Build Coastguard Worker     {
151*c2e0c6b5SAndroid Build Coastguard Worker     case 1:
152*c2e0c6b5SAndroid Build Coastguard Worker       buf[0] = intel_inb(addr);
153*c2e0c6b5SAndroid Build Coastguard Worker       break;
154*c2e0c6b5SAndroid Build Coastguard Worker     case 2:
155*c2e0c6b5SAndroid Build Coastguard Worker       ((u16 *) buf)[0] = cpu_to_le16(intel_inw(addr));
156*c2e0c6b5SAndroid Build Coastguard Worker       break;
157*c2e0c6b5SAndroid Build Coastguard Worker     case 4:
158*c2e0c6b5SAndroid Build Coastguard Worker       ((u32 *) buf)[0] = cpu_to_le32(intel_inl(addr));
159*c2e0c6b5SAndroid Build Coastguard Worker       break;
160*c2e0c6b5SAndroid Build Coastguard Worker     }
161*c2e0c6b5SAndroid Build Coastguard Worker 
162*c2e0c6b5SAndroid Build Coastguard Worker   intel_io_unlock();
163*c2e0c6b5SAndroid Build Coastguard Worker   return res;
164*c2e0c6b5SAndroid Build Coastguard Worker }
165*c2e0c6b5SAndroid Build Coastguard Worker 
166*c2e0c6b5SAndroid Build Coastguard Worker static int
conf1_write(struct pci_dev * d,int pos,byte * buf,int len)167*c2e0c6b5SAndroid Build Coastguard Worker conf1_write(struct pci_dev *d, int pos, byte *buf, int len)
168*c2e0c6b5SAndroid Build Coastguard Worker {
169*c2e0c6b5SAndroid Build Coastguard Worker   int addr = 0xcfc + (pos&3);
170*c2e0c6b5SAndroid Build Coastguard Worker   int res = 1;
171*c2e0c6b5SAndroid Build Coastguard Worker 
172*c2e0c6b5SAndroid Build Coastguard Worker   if (d->domain || pos >= 256)
173*c2e0c6b5SAndroid Build Coastguard Worker     return 0;
174*c2e0c6b5SAndroid Build Coastguard Worker 
175*c2e0c6b5SAndroid Build Coastguard Worker   if (len != 1 && len != 2 && len != 4)
176*c2e0c6b5SAndroid Build Coastguard Worker     return pci_generic_block_write(d, pos, buf, len);
177*c2e0c6b5SAndroid Build Coastguard Worker 
178*c2e0c6b5SAndroid Build Coastguard Worker   intel_io_lock();
179*c2e0c6b5SAndroid Build Coastguard Worker   intel_outl(0x80000000 | ((d->bus & 0xff) << 16) | (PCI_DEVFN(d->dev, d->func) << 8) | (pos&~3), 0xcf8);
180*c2e0c6b5SAndroid Build Coastguard Worker 
181*c2e0c6b5SAndroid Build Coastguard Worker   switch (len)
182*c2e0c6b5SAndroid Build Coastguard Worker     {
183*c2e0c6b5SAndroid Build Coastguard Worker     case 1:
184*c2e0c6b5SAndroid Build Coastguard Worker       intel_outb(buf[0], addr);
185*c2e0c6b5SAndroid Build Coastguard Worker       break;
186*c2e0c6b5SAndroid Build Coastguard Worker     case 2:
187*c2e0c6b5SAndroid Build Coastguard Worker       intel_outw(le16_to_cpu(((u16 *) buf)[0]), addr);
188*c2e0c6b5SAndroid Build Coastguard Worker       break;
189*c2e0c6b5SAndroid Build Coastguard Worker     case 4:
190*c2e0c6b5SAndroid Build Coastguard Worker       intel_outl(le32_to_cpu(((u32 *) buf)[0]), addr);
191*c2e0c6b5SAndroid Build Coastguard Worker       break;
192*c2e0c6b5SAndroid Build Coastguard Worker     }
193*c2e0c6b5SAndroid Build Coastguard Worker   intel_io_unlock();
194*c2e0c6b5SAndroid Build Coastguard Worker   return res;
195*c2e0c6b5SAndroid Build Coastguard Worker }
196*c2e0c6b5SAndroid Build Coastguard Worker 
197*c2e0c6b5SAndroid Build Coastguard Worker /*
198*c2e0c6b5SAndroid Build Coastguard Worker  *	Configuration type 2. Obsolete and brain-damaged, but existing.
199*c2e0c6b5SAndroid Build Coastguard Worker  */
200*c2e0c6b5SAndroid Build Coastguard Worker 
201*c2e0c6b5SAndroid Build Coastguard Worker static int
conf2_detect(struct pci_access * a)202*c2e0c6b5SAndroid Build Coastguard Worker conf2_detect(struct pci_access *a)
203*c2e0c6b5SAndroid Build Coastguard Worker {
204*c2e0c6b5SAndroid Build Coastguard Worker   int res = 0;
205*c2e0c6b5SAndroid Build Coastguard Worker 
206*c2e0c6b5SAndroid Build Coastguard Worker   if (!conf12_setup_io(a))
207*c2e0c6b5SAndroid Build Coastguard Worker     {
208*c2e0c6b5SAndroid Build Coastguard Worker       a->debug("...no I/O permission");
209*c2e0c6b5SAndroid Build Coastguard Worker       return 0;
210*c2e0c6b5SAndroid Build Coastguard Worker     }
211*c2e0c6b5SAndroid Build Coastguard Worker 
212*c2e0c6b5SAndroid Build Coastguard Worker   /* This is ugly and tends to produce false positives. Beware. */
213*c2e0c6b5SAndroid Build Coastguard Worker 
214*c2e0c6b5SAndroid Build Coastguard Worker   intel_io_lock();
215*c2e0c6b5SAndroid Build Coastguard Worker   intel_outb(0x00, 0xCFB);
216*c2e0c6b5SAndroid Build Coastguard Worker   intel_outb(0x00, 0xCF8);
217*c2e0c6b5SAndroid Build Coastguard Worker   intel_outb(0x00, 0xCFA);
218*c2e0c6b5SAndroid Build Coastguard Worker   if (intel_inb(0xCF8) == 0x00 && intel_inb(0xCFA) == 0x00)
219*c2e0c6b5SAndroid Build Coastguard Worker     res = intel_sanity_check(a, &pm_intel_conf2);
220*c2e0c6b5SAndroid Build Coastguard Worker   intel_io_unlock();
221*c2e0c6b5SAndroid Build Coastguard Worker   return res;
222*c2e0c6b5SAndroid Build Coastguard Worker }
223*c2e0c6b5SAndroid Build Coastguard Worker 
224*c2e0c6b5SAndroid Build Coastguard Worker static int
conf2_read(struct pci_dev * d,int pos,byte * buf,int len)225*c2e0c6b5SAndroid Build Coastguard Worker conf2_read(struct pci_dev *d, int pos, byte *buf, int len)
226*c2e0c6b5SAndroid Build Coastguard Worker {
227*c2e0c6b5SAndroid Build Coastguard Worker   int res = 1;
228*c2e0c6b5SAndroid Build Coastguard Worker   int addr = 0xc000 | (d->dev << 8) | pos;
229*c2e0c6b5SAndroid Build Coastguard Worker 
230*c2e0c6b5SAndroid Build Coastguard Worker   if (d->domain || pos >= 256)
231*c2e0c6b5SAndroid Build Coastguard Worker     return 0;
232*c2e0c6b5SAndroid Build Coastguard Worker 
233*c2e0c6b5SAndroid Build Coastguard Worker   if (d->dev >= 16)
234*c2e0c6b5SAndroid Build Coastguard Worker     /* conf2 supports only 16 devices per bus */
235*c2e0c6b5SAndroid Build Coastguard Worker     return 0;
236*c2e0c6b5SAndroid Build Coastguard Worker 
237*c2e0c6b5SAndroid Build Coastguard Worker   if (len != 1 && len != 2 && len != 4)
238*c2e0c6b5SAndroid Build Coastguard Worker     return pci_generic_block_read(d, pos, buf, len);
239*c2e0c6b5SAndroid Build Coastguard Worker 
240*c2e0c6b5SAndroid Build Coastguard Worker   intel_io_lock();
241*c2e0c6b5SAndroid Build Coastguard Worker   intel_outb((d->func << 1) | 0xf0, 0xcf8);
242*c2e0c6b5SAndroid Build Coastguard Worker   intel_outb(d->bus, 0xcfa);
243*c2e0c6b5SAndroid Build Coastguard Worker   switch (len)
244*c2e0c6b5SAndroid Build Coastguard Worker     {
245*c2e0c6b5SAndroid Build Coastguard Worker     case 1:
246*c2e0c6b5SAndroid Build Coastguard Worker       buf[0] = intel_inb(addr);
247*c2e0c6b5SAndroid Build Coastguard Worker       break;
248*c2e0c6b5SAndroid Build Coastguard Worker     case 2:
249*c2e0c6b5SAndroid Build Coastguard Worker       ((u16 *) buf)[0] = cpu_to_le16(intel_inw(addr));
250*c2e0c6b5SAndroid Build Coastguard Worker       break;
251*c2e0c6b5SAndroid Build Coastguard Worker     case 4:
252*c2e0c6b5SAndroid Build Coastguard Worker       ((u32 *) buf)[0] = cpu_to_le32(intel_inl(addr));
253*c2e0c6b5SAndroid Build Coastguard Worker       break;
254*c2e0c6b5SAndroid Build Coastguard Worker     }
255*c2e0c6b5SAndroid Build Coastguard Worker   intel_outb(0, 0xcf8);
256*c2e0c6b5SAndroid Build Coastguard Worker   intel_io_unlock();
257*c2e0c6b5SAndroid Build Coastguard Worker   return res;
258*c2e0c6b5SAndroid Build Coastguard Worker }
259*c2e0c6b5SAndroid Build Coastguard Worker 
260*c2e0c6b5SAndroid Build Coastguard Worker static int
conf2_write(struct pci_dev * d,int pos,byte * buf,int len)261*c2e0c6b5SAndroid Build Coastguard Worker conf2_write(struct pci_dev *d, int pos, byte *buf, int len)
262*c2e0c6b5SAndroid Build Coastguard Worker {
263*c2e0c6b5SAndroid Build Coastguard Worker   int res = 1;
264*c2e0c6b5SAndroid Build Coastguard Worker   int addr = 0xc000 | (d->dev << 8) | pos;
265*c2e0c6b5SAndroid Build Coastguard Worker 
266*c2e0c6b5SAndroid Build Coastguard Worker   if (d->domain || pos >= 256)
267*c2e0c6b5SAndroid Build Coastguard Worker     return 0;
268*c2e0c6b5SAndroid Build Coastguard Worker 
269*c2e0c6b5SAndroid Build Coastguard Worker   if (d->dev >= 16)
270*c2e0c6b5SAndroid Build Coastguard Worker     /* conf2 supports only 16 devices per bus */
271*c2e0c6b5SAndroid Build Coastguard Worker     return 0;
272*c2e0c6b5SAndroid Build Coastguard Worker 
273*c2e0c6b5SAndroid Build Coastguard Worker   if (len != 1 && len != 2 && len != 4)
274*c2e0c6b5SAndroid Build Coastguard Worker     return pci_generic_block_write(d, pos, buf, len);
275*c2e0c6b5SAndroid Build Coastguard Worker 
276*c2e0c6b5SAndroid Build Coastguard Worker   intel_io_lock();
277*c2e0c6b5SAndroid Build Coastguard Worker   intel_outb((d->func << 1) | 0xf0, 0xcf8);
278*c2e0c6b5SAndroid Build Coastguard Worker   intel_outb(d->bus, 0xcfa);
279*c2e0c6b5SAndroid Build Coastguard Worker   switch (len)
280*c2e0c6b5SAndroid Build Coastguard Worker     {
281*c2e0c6b5SAndroid Build Coastguard Worker     case 1:
282*c2e0c6b5SAndroid Build Coastguard Worker       intel_outb(buf[0], addr);
283*c2e0c6b5SAndroid Build Coastguard Worker       break;
284*c2e0c6b5SAndroid Build Coastguard Worker     case 2:
285*c2e0c6b5SAndroid Build Coastguard Worker       intel_outw(le16_to_cpu(* (u16 *) buf), addr);
286*c2e0c6b5SAndroid Build Coastguard Worker       break;
287*c2e0c6b5SAndroid Build Coastguard Worker     case 4:
288*c2e0c6b5SAndroid Build Coastguard Worker       intel_outl(le32_to_cpu(* (u32 *) buf), addr);
289*c2e0c6b5SAndroid Build Coastguard Worker       break;
290*c2e0c6b5SAndroid Build Coastguard Worker     }
291*c2e0c6b5SAndroid Build Coastguard Worker 
292*c2e0c6b5SAndroid Build Coastguard Worker   intel_outb(0, 0xcf8);
293*c2e0c6b5SAndroid Build Coastguard Worker   intel_io_unlock();
294*c2e0c6b5SAndroid Build Coastguard Worker   return res;
295*c2e0c6b5SAndroid Build Coastguard Worker }
296*c2e0c6b5SAndroid Build Coastguard Worker 
297*c2e0c6b5SAndroid Build Coastguard Worker struct pci_methods pm_intel_conf1 = {
298*c2e0c6b5SAndroid Build Coastguard Worker   .name = "intel-conf1",
299*c2e0c6b5SAndroid Build Coastguard Worker   .help = "Raw I/O port access using Intel conf1 interface",
300*c2e0c6b5SAndroid Build Coastguard Worker   .detect = conf1_detect,
301*c2e0c6b5SAndroid Build Coastguard Worker   .init = conf12_init,
302*c2e0c6b5SAndroid Build Coastguard Worker   .cleanup = conf12_cleanup,
303*c2e0c6b5SAndroid Build Coastguard Worker   .scan = pci_generic_scan,
304*c2e0c6b5SAndroid Build Coastguard Worker   .fill_info = pci_generic_fill_info,
305*c2e0c6b5SAndroid Build Coastguard Worker   .read = conf1_read,
306*c2e0c6b5SAndroid Build Coastguard Worker   .write = conf1_write,
307*c2e0c6b5SAndroid Build Coastguard Worker };
308*c2e0c6b5SAndroid Build Coastguard Worker 
309*c2e0c6b5SAndroid Build Coastguard Worker struct pci_methods pm_intel_conf2 = {
310*c2e0c6b5SAndroid Build Coastguard Worker   .name = "intel-conf2",
311*c2e0c6b5SAndroid Build Coastguard Worker   .help = "Raw I/O port access using Intel conf2 interface",
312*c2e0c6b5SAndroid Build Coastguard Worker   .detect = conf2_detect,
313*c2e0c6b5SAndroid Build Coastguard Worker   .init = conf12_init,
314*c2e0c6b5SAndroid Build Coastguard Worker   .cleanup = conf12_cleanup,
315*c2e0c6b5SAndroid Build Coastguard Worker   .scan = pci_generic_scan,
316*c2e0c6b5SAndroid Build Coastguard Worker   .fill_info = pci_generic_fill_info,
317*c2e0c6b5SAndroid Build Coastguard Worker   .read = conf2_read,
318*c2e0c6b5SAndroid Build Coastguard Worker   .write = conf2_write,
319*c2e0c6b5SAndroid Build Coastguard Worker };
320