1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * CHRP pci routines.
4*4882a593Smuzhiyun */
5*4882a593Smuzhiyun
6*4882a593Smuzhiyun #include <linux/kernel.h>
7*4882a593Smuzhiyun #include <linux/pci.h>
8*4882a593Smuzhiyun #include <linux/delay.h>
9*4882a593Smuzhiyun #include <linux/string.h>
10*4882a593Smuzhiyun #include <linux/init.h>
11*4882a593Smuzhiyun #include <linux/pgtable.h>
12*4882a593Smuzhiyun
13*4882a593Smuzhiyun #include <asm/io.h>
14*4882a593Smuzhiyun #include <asm/irq.h>
15*4882a593Smuzhiyun #include <asm/hydra.h>
16*4882a593Smuzhiyun #include <asm/prom.h>
17*4882a593Smuzhiyun #include <asm/machdep.h>
18*4882a593Smuzhiyun #include <asm/sections.h>
19*4882a593Smuzhiyun #include <asm/pci-bridge.h>
20*4882a593Smuzhiyun #include <asm/grackle.h>
21*4882a593Smuzhiyun #include <asm/rtas.h>
22*4882a593Smuzhiyun
23*4882a593Smuzhiyun #include "chrp.h"
24*4882a593Smuzhiyun #include "gg2.h"
25*4882a593Smuzhiyun
26*4882a593Smuzhiyun /* LongTrail */
27*4882a593Smuzhiyun void __iomem *gg2_pci_config_base;
28*4882a593Smuzhiyun
29*4882a593Smuzhiyun /*
30*4882a593Smuzhiyun * The VLSI Golden Gate II has only 512K of PCI configuration space, so we
31*4882a593Smuzhiyun * limit the bus number to 3 bits
32*4882a593Smuzhiyun */
33*4882a593Smuzhiyun
gg2_read_config(struct pci_bus * bus,unsigned int devfn,int off,int len,u32 * val)34*4882a593Smuzhiyun static int gg2_read_config(struct pci_bus *bus, unsigned int devfn, int off,
35*4882a593Smuzhiyun int len, u32 *val)
36*4882a593Smuzhiyun {
37*4882a593Smuzhiyun volatile void __iomem *cfg_data;
38*4882a593Smuzhiyun struct pci_controller *hose = pci_bus_to_host(bus);
39*4882a593Smuzhiyun
40*4882a593Smuzhiyun if (bus->number > 7)
41*4882a593Smuzhiyun return PCIBIOS_DEVICE_NOT_FOUND;
42*4882a593Smuzhiyun /*
43*4882a593Smuzhiyun * Note: the caller has already checked that off is
44*4882a593Smuzhiyun * suitably aligned and that len is 1, 2 or 4.
45*4882a593Smuzhiyun */
46*4882a593Smuzhiyun cfg_data = hose->cfg_data + ((bus->number<<16) | (devfn<<8) | off);
47*4882a593Smuzhiyun switch (len) {
48*4882a593Smuzhiyun case 1:
49*4882a593Smuzhiyun *val = in_8(cfg_data);
50*4882a593Smuzhiyun break;
51*4882a593Smuzhiyun case 2:
52*4882a593Smuzhiyun *val = in_le16(cfg_data);
53*4882a593Smuzhiyun break;
54*4882a593Smuzhiyun default:
55*4882a593Smuzhiyun *val = in_le32(cfg_data);
56*4882a593Smuzhiyun break;
57*4882a593Smuzhiyun }
58*4882a593Smuzhiyun return PCIBIOS_SUCCESSFUL;
59*4882a593Smuzhiyun }
60*4882a593Smuzhiyun
gg2_write_config(struct pci_bus * bus,unsigned int devfn,int off,int len,u32 val)61*4882a593Smuzhiyun static int gg2_write_config(struct pci_bus *bus, unsigned int devfn, int off,
62*4882a593Smuzhiyun int len, u32 val)
63*4882a593Smuzhiyun {
64*4882a593Smuzhiyun volatile void __iomem *cfg_data;
65*4882a593Smuzhiyun struct pci_controller *hose = pci_bus_to_host(bus);
66*4882a593Smuzhiyun
67*4882a593Smuzhiyun if (bus->number > 7)
68*4882a593Smuzhiyun return PCIBIOS_DEVICE_NOT_FOUND;
69*4882a593Smuzhiyun /*
70*4882a593Smuzhiyun * Note: the caller has already checked that off is
71*4882a593Smuzhiyun * suitably aligned and that len is 1, 2 or 4.
72*4882a593Smuzhiyun */
73*4882a593Smuzhiyun cfg_data = hose->cfg_data + ((bus->number<<16) | (devfn<<8) | off);
74*4882a593Smuzhiyun switch (len) {
75*4882a593Smuzhiyun case 1:
76*4882a593Smuzhiyun out_8(cfg_data, val);
77*4882a593Smuzhiyun break;
78*4882a593Smuzhiyun case 2:
79*4882a593Smuzhiyun out_le16(cfg_data, val);
80*4882a593Smuzhiyun break;
81*4882a593Smuzhiyun default:
82*4882a593Smuzhiyun out_le32(cfg_data, val);
83*4882a593Smuzhiyun break;
84*4882a593Smuzhiyun }
85*4882a593Smuzhiyun return PCIBIOS_SUCCESSFUL;
86*4882a593Smuzhiyun }
87*4882a593Smuzhiyun
88*4882a593Smuzhiyun static struct pci_ops gg2_pci_ops =
89*4882a593Smuzhiyun {
90*4882a593Smuzhiyun .read = gg2_read_config,
91*4882a593Smuzhiyun .write = gg2_write_config,
92*4882a593Smuzhiyun };
93*4882a593Smuzhiyun
94*4882a593Smuzhiyun /*
95*4882a593Smuzhiyun * Access functions for PCI config space using RTAS calls.
96*4882a593Smuzhiyun */
rtas_read_config(struct pci_bus * bus,unsigned int devfn,int offset,int len,u32 * val)97*4882a593Smuzhiyun static int rtas_read_config(struct pci_bus *bus, unsigned int devfn, int offset,
98*4882a593Smuzhiyun int len, u32 *val)
99*4882a593Smuzhiyun {
100*4882a593Smuzhiyun struct pci_controller *hose = pci_bus_to_host(bus);
101*4882a593Smuzhiyun unsigned long addr = (offset & 0xff) | ((devfn & 0xff) << 8)
102*4882a593Smuzhiyun | (((bus->number - hose->first_busno) & 0xff) << 16)
103*4882a593Smuzhiyun | (hose->global_number << 24);
104*4882a593Smuzhiyun int ret = -1;
105*4882a593Smuzhiyun int rval;
106*4882a593Smuzhiyun
107*4882a593Smuzhiyun rval = rtas_call(rtas_token("read-pci-config"), 2, 2, &ret, addr, len);
108*4882a593Smuzhiyun *val = ret;
109*4882a593Smuzhiyun return rval? PCIBIOS_DEVICE_NOT_FOUND: PCIBIOS_SUCCESSFUL;
110*4882a593Smuzhiyun }
111*4882a593Smuzhiyun
rtas_write_config(struct pci_bus * bus,unsigned int devfn,int offset,int len,u32 val)112*4882a593Smuzhiyun static int rtas_write_config(struct pci_bus *bus, unsigned int devfn, int offset,
113*4882a593Smuzhiyun int len, u32 val)
114*4882a593Smuzhiyun {
115*4882a593Smuzhiyun struct pci_controller *hose = pci_bus_to_host(bus);
116*4882a593Smuzhiyun unsigned long addr = (offset & 0xff) | ((devfn & 0xff) << 8)
117*4882a593Smuzhiyun | (((bus->number - hose->first_busno) & 0xff) << 16)
118*4882a593Smuzhiyun | (hose->global_number << 24);
119*4882a593Smuzhiyun int rval;
120*4882a593Smuzhiyun
121*4882a593Smuzhiyun rval = rtas_call(rtas_token("write-pci-config"), 3, 1, NULL,
122*4882a593Smuzhiyun addr, len, val);
123*4882a593Smuzhiyun return rval? PCIBIOS_DEVICE_NOT_FOUND: PCIBIOS_SUCCESSFUL;
124*4882a593Smuzhiyun }
125*4882a593Smuzhiyun
126*4882a593Smuzhiyun static struct pci_ops rtas_pci_ops =
127*4882a593Smuzhiyun {
128*4882a593Smuzhiyun .read = rtas_read_config,
129*4882a593Smuzhiyun .write = rtas_write_config,
130*4882a593Smuzhiyun };
131*4882a593Smuzhiyun
132*4882a593Smuzhiyun volatile struct Hydra __iomem *Hydra = NULL;
133*4882a593Smuzhiyun
134*4882a593Smuzhiyun int __init
hydra_init(void)135*4882a593Smuzhiyun hydra_init(void)
136*4882a593Smuzhiyun {
137*4882a593Smuzhiyun struct device_node *np;
138*4882a593Smuzhiyun struct resource r;
139*4882a593Smuzhiyun
140*4882a593Smuzhiyun np = of_find_node_by_name(NULL, "mac-io");
141*4882a593Smuzhiyun if (np == NULL || of_address_to_resource(np, 0, &r)) {
142*4882a593Smuzhiyun of_node_put(np);
143*4882a593Smuzhiyun return 0;
144*4882a593Smuzhiyun }
145*4882a593Smuzhiyun of_node_put(np);
146*4882a593Smuzhiyun Hydra = ioremap(r.start, resource_size(&r));
147*4882a593Smuzhiyun printk("Hydra Mac I/O at %llx\n", (unsigned long long)r.start);
148*4882a593Smuzhiyun printk("Hydra Feature_Control was %x",
149*4882a593Smuzhiyun in_le32(&Hydra->Feature_Control));
150*4882a593Smuzhiyun out_le32(&Hydra->Feature_Control, (HYDRA_FC_SCC_CELL_EN |
151*4882a593Smuzhiyun HYDRA_FC_SCSI_CELL_EN |
152*4882a593Smuzhiyun HYDRA_FC_SCCA_ENABLE |
153*4882a593Smuzhiyun HYDRA_FC_SCCB_ENABLE |
154*4882a593Smuzhiyun HYDRA_FC_ARB_BYPASS |
155*4882a593Smuzhiyun HYDRA_FC_MPIC_ENABLE |
156*4882a593Smuzhiyun HYDRA_FC_SLOW_SCC_PCLK |
157*4882a593Smuzhiyun HYDRA_FC_MPIC_IS_MASTER));
158*4882a593Smuzhiyun printk(", now %x\n", in_le32(&Hydra->Feature_Control));
159*4882a593Smuzhiyun return 1;
160*4882a593Smuzhiyun }
161*4882a593Smuzhiyun
162*4882a593Smuzhiyun #define PRG_CL_RESET_VALID 0x00010000
163*4882a593Smuzhiyun
164*4882a593Smuzhiyun static void __init
setup_python(struct pci_controller * hose,struct device_node * dev)165*4882a593Smuzhiyun setup_python(struct pci_controller *hose, struct device_node *dev)
166*4882a593Smuzhiyun {
167*4882a593Smuzhiyun u32 __iomem *reg;
168*4882a593Smuzhiyun u32 val;
169*4882a593Smuzhiyun struct resource r;
170*4882a593Smuzhiyun
171*4882a593Smuzhiyun if (of_address_to_resource(dev, 0, &r)) {
172*4882a593Smuzhiyun printk(KERN_ERR "No address for Python PCI controller\n");
173*4882a593Smuzhiyun return;
174*4882a593Smuzhiyun }
175*4882a593Smuzhiyun
176*4882a593Smuzhiyun /* Clear the magic go-slow bit */
177*4882a593Smuzhiyun reg = ioremap(r.start + 0xf6000, 0x40);
178*4882a593Smuzhiyun BUG_ON(!reg);
179*4882a593Smuzhiyun val = in_be32(®[12]);
180*4882a593Smuzhiyun if (val & PRG_CL_RESET_VALID) {
181*4882a593Smuzhiyun out_be32(®[12], val & ~PRG_CL_RESET_VALID);
182*4882a593Smuzhiyun in_be32(®[12]);
183*4882a593Smuzhiyun }
184*4882a593Smuzhiyun iounmap(reg);
185*4882a593Smuzhiyun
186*4882a593Smuzhiyun setup_indirect_pci(hose, r.start + 0xf8000, r.start + 0xf8010, 0);
187*4882a593Smuzhiyun }
188*4882a593Smuzhiyun
189*4882a593Smuzhiyun /* Marvell Discovery II based Pegasos 2 */
setup_peg2(struct pci_controller * hose,struct device_node * dev)190*4882a593Smuzhiyun static void __init setup_peg2(struct pci_controller *hose, struct device_node *dev)
191*4882a593Smuzhiyun {
192*4882a593Smuzhiyun struct device_node *root = of_find_node_by_path("/");
193*4882a593Smuzhiyun struct device_node *rtas;
194*4882a593Smuzhiyun
195*4882a593Smuzhiyun rtas = of_find_node_by_name (root, "rtas");
196*4882a593Smuzhiyun if (rtas) {
197*4882a593Smuzhiyun hose->ops = &rtas_pci_ops;
198*4882a593Smuzhiyun of_node_put(rtas);
199*4882a593Smuzhiyun } else {
200*4882a593Smuzhiyun printk ("RTAS supporting Pegasos OF not found, please upgrade"
201*4882a593Smuzhiyun " your firmware\n");
202*4882a593Smuzhiyun }
203*4882a593Smuzhiyun pci_add_flags(PCI_REASSIGN_ALL_BUS);
204*4882a593Smuzhiyun /* keep the reference to the root node */
205*4882a593Smuzhiyun }
206*4882a593Smuzhiyun
207*4882a593Smuzhiyun void __init
chrp_find_bridges(void)208*4882a593Smuzhiyun chrp_find_bridges(void)
209*4882a593Smuzhiyun {
210*4882a593Smuzhiyun struct device_node *dev;
211*4882a593Smuzhiyun const int *bus_range;
212*4882a593Smuzhiyun int len, index = -1;
213*4882a593Smuzhiyun struct pci_controller *hose;
214*4882a593Smuzhiyun const unsigned int *dma;
215*4882a593Smuzhiyun const char *model, *machine;
216*4882a593Smuzhiyun int is_longtrail = 0, is_mot = 0, is_pegasos = 0;
217*4882a593Smuzhiyun struct device_node *root = of_find_node_by_path("/");
218*4882a593Smuzhiyun struct resource r;
219*4882a593Smuzhiyun /*
220*4882a593Smuzhiyun * The PCI host bridge nodes on some machines don't have
221*4882a593Smuzhiyun * properties to adequately identify them, so we have to
222*4882a593Smuzhiyun * look at what sort of machine this is as well.
223*4882a593Smuzhiyun */
224*4882a593Smuzhiyun machine = of_get_property(root, "model", NULL);
225*4882a593Smuzhiyun if (machine != NULL) {
226*4882a593Smuzhiyun is_longtrail = strncmp(machine, "IBM,LongTrail", 13) == 0;
227*4882a593Smuzhiyun is_mot = strncmp(machine, "MOT", 3) == 0;
228*4882a593Smuzhiyun if (strncmp(machine, "Pegasos2", 8) == 0)
229*4882a593Smuzhiyun is_pegasos = 2;
230*4882a593Smuzhiyun else if (strncmp(machine, "Pegasos", 7) == 0)
231*4882a593Smuzhiyun is_pegasos = 1;
232*4882a593Smuzhiyun }
233*4882a593Smuzhiyun for_each_child_of_node(root, dev) {
234*4882a593Smuzhiyun if (!of_node_is_type(dev, "pci"))
235*4882a593Smuzhiyun continue;
236*4882a593Smuzhiyun ++index;
237*4882a593Smuzhiyun /* The GG2 bridge on the LongTrail doesn't have an address */
238*4882a593Smuzhiyun if (of_address_to_resource(dev, 0, &r) && !is_longtrail) {
239*4882a593Smuzhiyun printk(KERN_WARNING "Can't use %pOF: no address\n",
240*4882a593Smuzhiyun dev);
241*4882a593Smuzhiyun continue;
242*4882a593Smuzhiyun }
243*4882a593Smuzhiyun bus_range = of_get_property(dev, "bus-range", &len);
244*4882a593Smuzhiyun if (bus_range == NULL || len < 2 * sizeof(int)) {
245*4882a593Smuzhiyun printk(KERN_WARNING "Can't get bus-range for %pOF\n",
246*4882a593Smuzhiyun dev);
247*4882a593Smuzhiyun continue;
248*4882a593Smuzhiyun }
249*4882a593Smuzhiyun if (bus_range[1] == bus_range[0])
250*4882a593Smuzhiyun printk(KERN_INFO "PCI bus %d", bus_range[0]);
251*4882a593Smuzhiyun else
252*4882a593Smuzhiyun printk(KERN_INFO "PCI buses %d..%d",
253*4882a593Smuzhiyun bus_range[0], bus_range[1]);
254*4882a593Smuzhiyun printk(" controlled by %pOF", dev);
255*4882a593Smuzhiyun if (!is_longtrail)
256*4882a593Smuzhiyun printk(" at %llx", (unsigned long long)r.start);
257*4882a593Smuzhiyun printk("\n");
258*4882a593Smuzhiyun
259*4882a593Smuzhiyun hose = pcibios_alloc_controller(dev);
260*4882a593Smuzhiyun if (!hose) {
261*4882a593Smuzhiyun printk("Can't allocate PCI controller structure for %pOF\n",
262*4882a593Smuzhiyun dev);
263*4882a593Smuzhiyun continue;
264*4882a593Smuzhiyun }
265*4882a593Smuzhiyun hose->first_busno = hose->self_busno = bus_range[0];
266*4882a593Smuzhiyun hose->last_busno = bus_range[1];
267*4882a593Smuzhiyun
268*4882a593Smuzhiyun model = of_get_property(dev, "model", NULL);
269*4882a593Smuzhiyun if (model == NULL)
270*4882a593Smuzhiyun model = "<none>";
271*4882a593Smuzhiyun if (strncmp(model, "IBM, Python", 11) == 0) {
272*4882a593Smuzhiyun setup_python(hose, dev);
273*4882a593Smuzhiyun } else if (is_mot
274*4882a593Smuzhiyun || strncmp(model, "Motorola, Grackle", 17) == 0) {
275*4882a593Smuzhiyun setup_grackle(hose);
276*4882a593Smuzhiyun } else if (is_longtrail) {
277*4882a593Smuzhiyun void __iomem *p = ioremap(GG2_PCI_CONFIG_BASE, 0x80000);
278*4882a593Smuzhiyun hose->ops = &gg2_pci_ops;
279*4882a593Smuzhiyun hose->cfg_data = p;
280*4882a593Smuzhiyun gg2_pci_config_base = p;
281*4882a593Smuzhiyun } else if (is_pegasos == 1) {
282*4882a593Smuzhiyun setup_indirect_pci(hose, 0xfec00cf8, 0xfee00cfc, 0);
283*4882a593Smuzhiyun } else if (is_pegasos == 2) {
284*4882a593Smuzhiyun setup_peg2(hose, dev);
285*4882a593Smuzhiyun } else if (!strncmp(model, "IBM,CPC710", 10)) {
286*4882a593Smuzhiyun setup_indirect_pci(hose,
287*4882a593Smuzhiyun r.start + 0x000f8000,
288*4882a593Smuzhiyun r.start + 0x000f8010,
289*4882a593Smuzhiyun 0);
290*4882a593Smuzhiyun if (index == 0) {
291*4882a593Smuzhiyun dma = of_get_property(dev, "system-dma-base",
292*4882a593Smuzhiyun &len);
293*4882a593Smuzhiyun if (dma && len >= sizeof(*dma)) {
294*4882a593Smuzhiyun dma = (unsigned int *)
295*4882a593Smuzhiyun (((unsigned long)dma) +
296*4882a593Smuzhiyun len - sizeof(*dma));
297*4882a593Smuzhiyun pci_dram_offset = *dma;
298*4882a593Smuzhiyun }
299*4882a593Smuzhiyun }
300*4882a593Smuzhiyun } else {
301*4882a593Smuzhiyun printk("No methods for %pOF (model %s), using RTAS\n",
302*4882a593Smuzhiyun dev, model);
303*4882a593Smuzhiyun hose->ops = &rtas_pci_ops;
304*4882a593Smuzhiyun }
305*4882a593Smuzhiyun
306*4882a593Smuzhiyun pci_process_bridge_OF_ranges(hose, dev, index == 0);
307*4882a593Smuzhiyun
308*4882a593Smuzhiyun /* check the first bridge for a property that we can
309*4882a593Smuzhiyun use to set pci_dram_offset */
310*4882a593Smuzhiyun dma = of_get_property(dev, "ibm,dma-ranges", &len);
311*4882a593Smuzhiyun if (index == 0 && dma != NULL && len >= 6 * sizeof(*dma)) {
312*4882a593Smuzhiyun pci_dram_offset = dma[2] - dma[3];
313*4882a593Smuzhiyun printk("pci_dram_offset = %lx\n", pci_dram_offset);
314*4882a593Smuzhiyun }
315*4882a593Smuzhiyun }
316*4882a593Smuzhiyun of_node_put(root);
317*4882a593Smuzhiyun }
318*4882a593Smuzhiyun
319*4882a593Smuzhiyun /* SL82C105 IDE Control/Status Register */
320*4882a593Smuzhiyun #define SL82C105_IDECSR 0x40
321*4882a593Smuzhiyun
322*4882a593Smuzhiyun /* Fixup for Winbond ATA quirk, required for briq mostly because the
323*4882a593Smuzhiyun * 8259 is configured for level sensitive IRQ 14 and so wants the
324*4882a593Smuzhiyun * ATA controller to be set to fully native mode or bad things
325*4882a593Smuzhiyun * will happen.
326*4882a593Smuzhiyun */
chrp_pci_fixup_winbond_ata(struct pci_dev * sl82c105)327*4882a593Smuzhiyun static void chrp_pci_fixup_winbond_ata(struct pci_dev *sl82c105)
328*4882a593Smuzhiyun {
329*4882a593Smuzhiyun u8 progif;
330*4882a593Smuzhiyun
331*4882a593Smuzhiyun /* If non-briq machines need that fixup too, please speak up */
332*4882a593Smuzhiyun if (!machine_is(chrp) || _chrp_type != _CHRP_briq)
333*4882a593Smuzhiyun return;
334*4882a593Smuzhiyun
335*4882a593Smuzhiyun if ((sl82c105->class & 5) != 5) {
336*4882a593Smuzhiyun printk("W83C553: Switching SL82C105 IDE to PCI native mode\n");
337*4882a593Smuzhiyun /* Enable SL82C105 PCI native IDE mode */
338*4882a593Smuzhiyun pci_read_config_byte(sl82c105, PCI_CLASS_PROG, &progif);
339*4882a593Smuzhiyun pci_write_config_byte(sl82c105, PCI_CLASS_PROG, progif | 0x05);
340*4882a593Smuzhiyun sl82c105->class |= 0x05;
341*4882a593Smuzhiyun /* Disable SL82C105 second port */
342*4882a593Smuzhiyun pci_write_config_word(sl82c105, SL82C105_IDECSR, 0x0003);
343*4882a593Smuzhiyun /* Clear IO BARs, they will be reassigned */
344*4882a593Smuzhiyun pci_write_config_dword(sl82c105, PCI_BASE_ADDRESS_0, 0);
345*4882a593Smuzhiyun pci_write_config_dword(sl82c105, PCI_BASE_ADDRESS_1, 0);
346*4882a593Smuzhiyun pci_write_config_dword(sl82c105, PCI_BASE_ADDRESS_2, 0);
347*4882a593Smuzhiyun pci_write_config_dword(sl82c105, PCI_BASE_ADDRESS_3, 0);
348*4882a593Smuzhiyun }
349*4882a593Smuzhiyun }
350*4882a593Smuzhiyun DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_WINBOND, PCI_DEVICE_ID_WINBOND_82C105,
351*4882a593Smuzhiyun chrp_pci_fixup_winbond_ata);
352*4882a593Smuzhiyun
353*4882a593Smuzhiyun /* Pegasos2 firmware version 20040810 configures the built-in IDE controller
354*4882a593Smuzhiyun * in legacy mode, but sets the PCI registers to PCI native mode.
355*4882a593Smuzhiyun * The chip can only operate in legacy mode, so force the PCI class into legacy
356*4882a593Smuzhiyun * mode as well. The same fixup must be done to the class-code property in
357*4882a593Smuzhiyun * the IDE node /pci@80000000/ide@C,1
358*4882a593Smuzhiyun */
chrp_pci_fixup_vt8231_ata(struct pci_dev * viaide)359*4882a593Smuzhiyun static void chrp_pci_fixup_vt8231_ata(struct pci_dev *viaide)
360*4882a593Smuzhiyun {
361*4882a593Smuzhiyun u8 progif;
362*4882a593Smuzhiyun struct pci_dev *viaisa;
363*4882a593Smuzhiyun
364*4882a593Smuzhiyun if (!machine_is(chrp) || _chrp_type != _CHRP_Pegasos)
365*4882a593Smuzhiyun return;
366*4882a593Smuzhiyun if (viaide->irq != 14)
367*4882a593Smuzhiyun return;
368*4882a593Smuzhiyun
369*4882a593Smuzhiyun viaisa = pci_get_device(PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_8231, NULL);
370*4882a593Smuzhiyun if (!viaisa)
371*4882a593Smuzhiyun return;
372*4882a593Smuzhiyun dev_info(&viaide->dev, "Fixing VIA IDE, force legacy mode on\n");
373*4882a593Smuzhiyun
374*4882a593Smuzhiyun pci_read_config_byte(viaide, PCI_CLASS_PROG, &progif);
375*4882a593Smuzhiyun pci_write_config_byte(viaide, PCI_CLASS_PROG, progif & ~0x5);
376*4882a593Smuzhiyun viaide->class &= ~0x5;
377*4882a593Smuzhiyun
378*4882a593Smuzhiyun pci_dev_put(viaisa);
379*4882a593Smuzhiyun }
380*4882a593Smuzhiyun DECLARE_PCI_FIXUP_FINAL(PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_82C586_1, chrp_pci_fixup_vt8231_ata);
381