2 * Define the pci_ops for the Toshiba rbtx4938
3 * Copyright (C) 2000-2001 Toshiba Corporation
5 * 2003-2005 (c) MontaVista Software, Inc. This file is licensed under the
6 * terms of the GNU General Public License version 2. This program is
7 * licensed "as is" without any warranty of any kind, whether express
10 * Support for TX4938 in 2.6 - Manish Lachwani (mlachwani@mvista.com)
12 #include <linux/types.h>
13 #include <linux/pci.h>
14 #include <linux/kernel.h>
15 #include <linux/init.h>
17 #include <asm/addrspace.h>
18 #include <asm/tx4938/rbtx4938.h>
20 /* initialize in setup */
21 struct resource pci_io_resource = {
22 .name = "pci IO space",
25 .flags = IORESOURCE_IO
28 /* initialize in setup */
29 struct resource pci_mem_resource = {
30 .name = "pci memory space",
33 .flags = IORESOURCE_MEM
36 struct resource tx4938_pcic1_pci_io_resource = {
40 .flags = IORESOURCE_IO
42 struct resource tx4938_pcic1_pci_mem_resource = {
46 .flags = IORESOURCE_MEM
49 static int mkaddr(int bus, int dev_fn, int where,
50 struct tx4938_pcic_reg *pcicptr)
53 /* Type 1 configuration */
54 pcicptr->g2pcfgadrs = ((bus & 0xff) << 0x10) |
55 ((dev_fn & 0xff) << 0x08) | (where & 0xfc) | 1;
57 if (dev_fn >= PCI_DEVFN(TX4938_PCIC_MAX_DEVNU, 0))
60 /* Type 0 configuration */
61 pcicptr->g2pcfgadrs = ((bus & 0xff) << 0x10) |
62 ((dev_fn & 0xff) << 0x08) | (where & 0xfc);
64 /* clear M_ABORT and Disable M_ABORT Int. */
66 (pcicptr->pcistatus & 0x0000ffff) |
67 (PCI_STATUS_REC_MASTER_ABORT << 16);
68 pcicptr->pcimask &= ~PCI_STATUS_REC_MASTER_ABORT;
73 static int check_abort(struct tx4938_pcic_reg *pcicptr)
75 int code = PCIBIOS_SUCCESSFUL;
76 /* wait write cycle completion before checking error status */
77 while (pcicptr->pcicstatus & TX4938_PCIC_PCICSTATUS_IWB)
79 if (pcicptr->pcistatus & (PCI_STATUS_REC_MASTER_ABORT << 16)) {
82 pcistatus & 0x0000ffff) | (PCI_STATUS_REC_MASTER_ABORT
84 pcicptr->pcimask |= PCI_STATUS_REC_MASTER_ABORT;
85 code = PCIBIOS_DEVICE_NOT_FOUND;
90 extern struct pci_controller tx4938_pci_controller[];
91 extern struct tx4938_pcic_reg *get_tx4938_pcicptr(int ch);
93 static struct tx4938_pcic_reg *pci_bus_to_pcicptr(struct pci_bus *bus)
95 struct pci_controller *channel = bus->sysdata;
96 return get_tx4938_pcicptr(channel - &tx4938_pci_controller[0]);
99 static int tx4938_pcibios_read_config(struct pci_bus *bus, unsigned int devfn,
100 int where, int size, u32 * val)
102 int retval, dev, busno, func;
103 struct tx4938_pcic_reg *pcicptr = pci_bus_to_pcicptr(bus);
104 void __iomem *cfgdata =
105 (void __iomem *)(unsigned long)&pcicptr->g2pcfgdata;
107 dev = PCI_SLOT(devfn);
108 func = PCI_FUNC(devfn);
110 /* check if the bus is top-level */
111 if (bus->parent != NULL)
117 if (mkaddr(busno, devfn, where, pcicptr))
123 cfgdata += (where & 3) ^ 3;
125 cfgdata += where & 3;
127 *val = __raw_readb(cfgdata);
131 cfgdata += (where & 2) ^ 2;
133 cfgdata += where & 2;
135 *val = __raw_readw(cfgdata);
138 *val = __raw_readl(cfgdata);
142 retval = check_abort(pcicptr);
143 if (retval == PCIBIOS_DEVICE_NOT_FOUND)
149 static int tx4938_pcibios_write_config(struct pci_bus *bus, unsigned int devfn, int where,
152 int dev, busno, func;
153 struct tx4938_pcic_reg *pcicptr = pci_bus_to_pcicptr(bus);
154 void __iomem *cfgdata =
155 (void __iomem *)(unsigned long)&pcicptr->g2pcfgdata;
158 dev = PCI_SLOT(devfn);
159 func = PCI_FUNC(devfn);
161 /* check if the bus is top-level */
162 if (bus->parent != NULL) {
168 if (mkaddr(busno, devfn, where, pcicptr))
174 cfgdata += (where & 3) ^ 3;
176 cfgdata += where & 3;
178 __raw_writeb(val, cfgdata);
182 cfgdata += (where & 2) ^ 2;
184 cfgdata += where & 2;
186 __raw_writew(val, cfgdata);
189 __raw_writel(val, cfgdata);
193 return check_abort(pcicptr);
196 struct pci_ops tx4938_pci_ops = {
197 tx4938_pcibios_read_config,
198 tx4938_pcibios_write_config
201 struct pci_controller tx4938_pci_controller[] = {
202 /* h/w only supports devices 0x00 to 0x14 */
204 .pci_ops = &tx4938_pci_ops,
205 .io_resource = &pci_io_resource,
206 .mem_resource = &pci_mem_resource,
208 /* h/w only supports devices 0x00 to 0x14 */
210 .pci_ops = &tx4938_pci_ops,
211 .io_resource = &tx4938_pcic1_pci_io_resource,
212 .mem_resource = &tx4938_pcic1_pci_mem_resource,